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“工业 机 器 人 及 其 应 用 ”是 高 等 工科 院 校 机 械 设 计 制 造 及 其 自动 化 专业 、 电 气 自动 化 专 
业 及 相关 专业 课程 体系 中 一 门 重要 的 课程 。 随 着 科学 技术 的 迅猛 发 展 ， 传 统 的 机 器 人 技术 的 
内 涵 正 在 不 断 地 发 生变 化 ， 同 时 各 院 校 课程 体系 改革 深入 展开 ， 对 外 交流 也 日 益 增 加 ， 这 使 
得 本 课程 面临 着 新 的 挑战 。 为 了 更 好 地 适应 机 械 设计 制造 及 其 自动 化 专业 、 电 气 自动 化 专业 
的 发 展 ， 以 及 培养 人 才 的 需要 ， 按 照 专 业 教学 指导 委员 会 推荐 的 指导 性 教学 计划 要 求 ， 结 合 
编者 多 年 来 的 教学 实践 ， 参 考 了 大 量 的 国内 外 相关 文献 ， 由 此 编写 而 成 本 书 。 本 书 具 有 如 下 
特点 : 

1. 在 名 词 术 语 、 符 号 代号 、 单 位 量 纲 等 方面 ， 全 书 始 终 贯彻 执行 新 的 国家 标准 。 描 述 
规范 、 科 学 统一 。 

2. 将 工业 机 器 人 的 结构 设计 、 运 动 学 和 动力 学 分 析 、 控 制 技 术 、 总 体 设计 和 应 用 等 方 
面 的 理论 知识 有 机 统一 ， 阐 述 由 浅 入 深 ， 形 成 了 工业 机 器 人 技术 的 知识 体系 ， 符合 认 知 
规律 。 

3. 注重 对 基本 概念 和 基本 知识 的 理解 和 掌握 ， 突 出 原理 的 应 用 ， 注 重工 程 实际 问题 的 
分 析 和 人 解决， 贴近 实际 应 用 。 

4. 本 书 适 应 面 广 ， 既 可 作为 本 科 生 教材 ， 也 可 作为 高 职高 专 学 生 教材 ， 既 适用 于 机 械 
设计 制造 及 其 自动 化 专业 、 电 气 自 动 化 专业 的 学 生 ， 也 可 供 相关 工程 技术 人 员 参 考 。 

全 书 共 八 章 ， 主 要 内 容 包 括 : 绪论 、 机 器 人 机 械 系 统 、 机 器 人 数学 基础 、 机 器 人 运动 
学 、 机 器 人 动力 学 、 机 器 人 控制 系统 、 机 器 人 轨迹 规划 、 机 器 人 设计 方法 和 应 用 及 其 发 展 。 
各 章 后 备 有 习题 ， 便 于 读者 自学 。 

参加 本 书 编写 的 有 袁 夫 彩 (第 1 章 、 第 2 章 、 第 8 章 ) 、 翟 雪琴 (第 3 章 、 第 4 章 、 第 
5 章 第 1~3 节 ) 、 王 才 东 (第 5 章 第 4~9 节 、 第 6 章 、 第 7 章 )。 本 书 由 袁 夫 彩 任 主编 ， 翟 
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本 章 主 要 介绍 机 器 人 的 由 来 、 定 义 、 分 类 、 结 构 特 点 和 国内 外 的 发 展 情况 ， 分 析 机 器 人 














涉及 的 相关 理论 及 技术 。 通 过 本 章 的 学 习 ， 希 望 读者 对 机 器 人 有 一 个 初步 的 认识 。 
1.1 机 费 人 的 发 展 


机 器 人 涉及 了 机 械 工 程 、 电 子 技术 、 计 算 机 技术 、 自 动 控制 理论 及 人 工 智 能 等 多 学 科 知 
识 ， 代表 了 机 电 一 体 化 的 新 成 就 ， 是 当代 科学 技术 发 展 较 活路 的 领域 之 一 。 “机 器 人 ”一 词 
虽 出 现 得 较 晚 ， 但 这 一 概念 在 人 类 的 想象 中 却 早 已 出 现 。 研 制 和 使 用 机 器 人 是 人 们 多 年 的 梦 
想 ， 这 体现 了 人 类 重 塑 自 身 、 了 解 自我 的 一 种 强烈 愿望 。 

自古 以 来 ， 有 不 少 学 者 和 杰出 工匠 都 曾 研制 出 具有 人 类 特点 或 具有 模拟 动物 特征 的 机 器 
人 雏形 。 在 中 国 ， 西 周 时 期 的 能 工 巧 折 候 师 就 研制 出 了 能 歌 善 舞 的 伶 人 ， 这 是 我 国 较 早 的 涉 
及 机 器 人 概念 的 文字 记载 ; 春秋 后 期 ， 著 名 的 木 哲 鲁班 曾 制 造 过 一 只 木 鸟 ， 能 在 空中 飞行 
“三 日 而 不 下 ”。 

“机 器 人 ”(Robot) 一 词 ， 是 1920 年 由 捷克 剧 作家 卡 雷 尔 . 卡 佩 克 (Karel Capek) 在 
他 的 讽刺 剧本 “ 罗 莎 姆 的 万 能 机 器 人 ”中 首先 提出 的 。 剧 中 描述 了 一 个 与 人 类 相似 ,但 能 
不 知 疲倦 工作 的 机 器 奴仆 (Robot) 。 从 那 时 起 ，“Robot” 一 词 就 被 沿用 下 来 ， 中 文 译 成 机 
器 人 。 

1942 年 美国 科 约 作家 阿 西 莫 夫 (Isaac Asimov) ， 在 他 的 科幻 小 说 《我 ， 机 器 人 》 中 提 
出 了 “机 器 人 三 原则 ”: 中 机 吉 人 不 能 危害 人 类 ， 不 能 眼看 人 类 受伤 害 而 袖手旁观 ; @ 机 器 














人 必须 服从 于 人 类 ， 除 非 违背 第 一 条 原则 ; @ 机 器 人 应 该 能 够 保护 自身 不 受伤 害 ， 除 非 违背 
第 一 条 和 第 二 条 原则 。 虽 然 这 三 条 原则 ， 只 是 科幻 小 说 里 的 创造 ， 但 后 来 成 为 学 术 界 默认 的 


机 器 人 研发 准则 ， 因 为 它 给 机 需 人 赋予 了 伦理 观 。 

现代 机 器 人 出 现 于 20 世纪 中 期 ， 当 时 数字 计算 机 已 经 出 现 ， 电 子 技术 也 有 了 长 足 的 
发 展 ， 在 产业 领域 出 现 了 受 计 算 机 控制 的 可 编程 的 数控 机 床 ， 与 机 器 人 技术 相关 的 控制 
技术 和 机 械 加 工 技 术 也 己 有 了 一 定 的 基础 。 另 外 ， 从 主观 方面 来 看 ， 人 类 需要 开发 机 融 
人 ， 蔡 代 人 去 从 事 一 些 恶劣 环境 下 的 作业 。 正 是 在 这 一 背景 下 ,， 机 器 人 技术 的 研究 与 应 
用 得 到 了 快速 发 展 。 下 面 列举 一 些 现代 机 器 人 工业 史上 的 标志 性 事件 ， 以 展示 机 器 人 的 
发 展 历程 。 

1954 年 ， 美 国人 戴 沃 尔 (G. C. Devol) 获得 了 世界 上 第 一 台 可 编程 的 机 械 手 的 注册 专 
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利 。 这 种 机 械 手 能 按照 一 定 的 程序 从 事 工作 ， 因 此 具有 通用 性 和 灵活 性 。 

1959 年 ， 戴 沃 尔 与 美国 发 明 家 英 格 伯 格 联手 制造 出 具有 实用 价值 的 第 一 台 工 业 机 器 人 。 
随后 ,成 立 了 世界 上 第 一 家 机 器 人 制造 工厂 一 一 “Unimation” 公 司 。 由 于 英 格 伯 格 对 工业 
机 融 人 富有 成 效 的 研发 和 宣传 ， 他 被 称 为 “工业 机 融 人 之 父 ”。 

1962 年 ， 美 国 AMF 公司 生产 出 万 能 搬运 (Versatran) 机 器 人 人， 与 Unimation 公司 生产 
的 万 能 伙伴 〈Unimate) 机 需 人 一 样 成 为 真正 商业 化 的 工业 机 器 人 ， 并 出 口 到 世界 各 国 ， 拢 
起 了 全 世界 对 机 器 人 的 热潮 。 

1967 年 ， 日 本 川崎 重工 公司 和 丰田 公司 分 别 从 美国 购买 了 工业 机 需 人 Unimate 和 
Versatran 的 生产 许可 证 ， 日 本 从 此 开始 了 对 机 需 人 的 研究 和 制造 。20 世纪 60 年 代 后 期 ， 喷 
涂 弧 焊 机 右 人 问世 并 逐步 开始 应 用 于 工业 生产 。 

1979 年 ， 美 国 Unimation 公司 推出 通用 工业 机 器 人 PUMA ， 如 图 1-1 所 示 。 这 标志 着 工 
业 机 器 人 技术 已 经 基本 成 熟 。PUMA 至 今 仍然 工作 在 生产 第 一 线 ， 许 多 机 器 人 技术 的 研究 都 
以 该 机 器 人 为 模型 和 对 象 。 

1979 年 ， 日 本 山梨 大 学 牧野 洋 发 明了 平面 关节 型 SCARA 机 器 人 ， 如 岁 1-2 所 示 。 在 此 
后 的 装配 作业 中 得 到 了 广泛 应 用 。 

















图 1-1 PUMA 机 器 人 示意 图 图 1-2 SCARA 机 器 人 示意 图 


1980 年 ， 日 本 定 为 机 器 人 普及 元 年 ， 启 得 了 “机 器 人 王国 ”的 美称 。 

1996 年, 日 本 本 田 公 司 推出 仿 人 型 机 器 人 P2， 使 双 足 行走 机 器 人 的 研究 达到 了 一 个 新 
的 水 平 。 随 后 许多 国际 著名 企业 争 相 研制 代表 自己 公司 形象 的 仿 人 型 机 器 人 ， 以 展示 公司 的 
科研 实力 。 

1998 年 ， 丹 麦 Lego 公司 推出 机 器 人 (Mind-storms) 套件 ， 使 机 器 人 制造 变 得 跟 搭 积 
一 样 ， 相 对 简单 又 能 任意 拼装 ， 使 机 器 人 开始 走 人 个 人 家 庭 世界 。 

1999 年 ， 日 本 索尼 公司 推出 机 器 狗 爱 宝 (AIBO) ， 当 即 销售 一 空 ， 从 此 娱乐 机 器 
人 成 为 目前 机 器 人 迈进 普通 家 庭 的 途径 之 一 。 

2002 年 ， 美 国 iRobot 公司 推出 了 吸尘器 机 器 人 Roomba， 是 目前 世界 上 销量 较 大 、 极 具 
商业 化 的 家 用 机 器 人 。 

2006 年 ， 微 软 公司 推出 Microsoft Robotics Studio， 机 器 人 模块 化 、 平 台 统 一 化 的 趋势 越 
来 越 明 显 。 比 尔 . 盖 蒋 预言， 家 用 机 器 人 很 快 将 席卷 全 球 。 
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中 国 的 机 器 人 技术 起 步 较 晚 ， 从 20 世纪 70 年 代 初 才 开始 。 我 国 在 “七 五 ”计划 中 
把 机 器 人 列 入 国家 重点 科研 规划 内 容 ; 在 “863” 计 划 的 支持 下 ， 机 器 人 基础 理论 与 技术 
研究 全 面 展 开 。 我 国 第 一 个 机 器 人 研究 示范 工程 于 1986 年 在 沈阳 建立 。 目 前 我 国 已 基本 
掌握 了 机 器 人 的 设计 制造 技术 、 控 制 系统 硬件 和 软件 设计 技术 、 运 动 学 和 轨迹 规划 技术 ， 
生产 了 机 器 人 关键 元 器 件 ， 开 发 出 了 喷涂 、 弧 焊 、 点 焊 、 装 配 和 搬运 等 机 器 人 。 截 至 
2007 年 年 底 ， 已 有 130 多 台 ( 套 ) 喷涂 机 器 人 在 20 余 家 企业 的 近 30 条 自动 喷涂 生产 线 
(站 ) 上 获得 规模 应 用 。 弧 焊 机 器 人 已 应 用 在 汽车 制造 三 的 焊 装 线 上 。20 世纪 90 年 代 中 
期 ， 我 国 6000m 以 浅 的 深水 作业 水 下 机 器 人 试验 成 功 。 以 后 的 近 10 年 中 ， 在 步行 机 器 
人 、 精 密 装配 机 器 人 和 多 自由 度 关 节 机 器 人 等 国际 前 沿 领域 ， 我 国 逐 步 缩小 了 与 世界 先 
进 水 平 的 差距 。 

2012 年 6 月 ,在 马里 亚 纳 海沟 ,我国 的 “蛟龙 ”号 载 人 潜水 器 (水 下 机 器 人 ) 完成 了 
7000m 级 海 试 任务 ， 首 次 到 达 7000m 深 的 海底 开展 作业 和 科学 研究 试验 ; 也 是 在 2012 年 6 
月 ， 我 国 天宫 一 号 与 神舟 九 号 载 人 交会 对 接 成 功 ， 标 志 着 我 国 载 人 航天 工程 的 一 个 重大 突 
破 。 这 些 表 明 ， 我 国 在 水 下 机 器 人 和 空间 机 器 人 等 领域 已 经 达到 了 世界 先进 水 平 。 


1.2 机 器 人 的 定义 、 特 征 、 结 构 和 技术 参数 
































1.2.1 机 器 人 的 定义 和 特征 


虽然 机 器 人 问世 已 有 几 十 年 ， 但 目前 关于 机 器 人 仍然 没有 一 个 统一 、 严 格 、 准 确 的 科学 
定义 。 其 原因 之 一 是 机 器 人 还 在 发 展 ， 新 的 机 型 不 断 涌 现 ， 机 器 人 可 实现 的 功能 不 断 增 多 ; 
而 根本 原因 则 是 机 器 人 涉及 了 人 的 概念 ， 这 就 使 什么 是 机 器 人 成 为 一 个 难以 回答 的 哲学 问 
题 。 就 像 “ 机 器 人 ”一 词 最 早 诞生 于 科幻 小 说 中 一 样 ， 人 们 对 机 器 人 充满 了 幻想 。 也 许 正 
是 目前 机 器 人 定义 的 模糊 性 ， 才 给 予 了 人 们 充分 的 想象 和 创造 的 空间 。 

目前 大 多 数 国 家 倾向 于 美国 机 器 人 工业 协会 (RIA) 给 出 的 定义 : 机 器 人 是 一 种 用 于 移 
动 各 种 材料 、 零 件 、 工 具 或 专用 装置 ， 通 过 可 编程 序 动作 来 执行 各 种 任务 ， 并 具有 编程 能 
的 多 功能 机 械 手 。 这 个 定义 实际 上 表述 的 是 工业 机 器 人 。 

日 本 工业 机 器 人 协会 (JIRA) 给 出 的 定义 : 一 种 带 有 存储 器 件 和 末端 操作 器 的 通用 机 
械 ， 它 能 够 通过 自动 化 的 动作 替代 人 类 劳动 。 

我 国学 者 对 机 器 人 的 定义 是 : 机 器 人 是 一 种 自动 化 的 机 器 ， 所 不 同 的 是 这 种 机 器 具备 一 
些 与 人 或 生物 相似 的 智能 能 力 ， 如 感知 、 规 划 、 动 作 和 协同 等 能 力 ， 是 一 种 具有 高 度 灵 活性 
的 自动 化 机 器 。 
通常 ， 机 器 人 应 该 具有 以 下 三 大 特征 : 

(1) 拟 生物 功能 ”机 器 人 是 模仿 人 或 其 他 生物 动作 的 机 器 ， 能 像 人 那样 使 用 工具 。 因 
此 ， 数 控 机 床 和 汽车 不 是 机 器 人 。 

(2) 可 编程 ”机 器 人 具有 智力 或 具有 感觉 与 识别 能 力 ， 可 随 工作 环境 变化 的 需要 而 再 
编程 。 一 般 的 电动 玩具 没有 感觉 和 识别 能 力 ， 不 能 再 编程 ， 因 此 不 能 称 为 真正 的 机 器 人 。 

(3) 通用 性 ”一般 机 器 人 在 执行 不 同 作业 任务 时 ， 具 有 较 好 的 通用 性 。 例 如 ， 通 过 更 
换 机 器 人 手 部 末端 操作 器 〈 手 爪 或 工具 等 ) ， 便 可 执行 不 同 的 作业 任务 。 
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1.2.2 机 器 人 的 结构 


机 器 人 系统 是 由 机 器 人 、 作 业 对 象 、 环 境 和 任务 等 组 成 的 。 其 中 包括 机 器 人 机 械 系 统 、 
驱动 系统 、 控 制 系统 和 检测 系统 等 ， 它 们 之 间 的 关系 如 图 1-3 所 示 。 由 图 可 见 ， 机 带 人 通过 
人 机 交互 系统 接收 作业 任务 ， 控 制 系统 发 出 控制 命令 ; 驱动 系统 接收 命令 后 驱动 机 械 系统 执 
行 任务 ， 从 而 改变 作业 对 象 ; 检测 系统 可 以 感知 机 器 人 内 部 及 外 部 信息 ， 将 检测 的 信息 与 给 
定 的 信息 进行 比较 ， 从 而 修正 控制 信号 ， 保 证 机 器 人 的 正确 作业 。 

(1) 控制 系统 该 系统 的 任务 是 根据 机 器 人 的 作业 指令 程序 ， 以 及 从 传感器 反馈 回来 
的 信号 ， 控 制 机 器 人 的 执行 机 构 ， 使 其 完成 规定 的 运动 和 功能 。 如 果 机 器 人 不 具备 信息 反馈 
环节 ， 则 该 控制 系统 称 为 开 环 控制 系统 ; 如 果 机 器 人 具备 信息 反馈 特征 ， 则 该 控制 系统 称 为 
闭环 控制 系统 。 该 控制 系统 部 分 主要 由 控制 系统 硬件 和 软件 组 成 。 软 件 主 要 由 人 与 机 絮 人 进 
行 联系 的 人 机 交互 系统 和 控制 算法 等 组 成 。 该 控制 系统 部 分 的 作用 相当 于 人 的 大 脑 。 


控制 系统 驱动 系统 机 械 系统 

Controller Actuator Mechanism 
检测 系统 

Sensor 


图 1-3 机 器 人 系统 结构 示意 图 


(2) 驱动 系统 “主要 指 驱动 机 械 系统 动作 的 动力 装置 。 根 据 驱 动 源 的 不 同 ， 驱 动 可 分 
为 电气 、 液 压 和 气压 等 驱动 方式 ， 以 及 把 它们 结合 起 来 应 用 的 综合 驱动 系统 。 该 部 分 的 作用 
相当 于 人 的 肌肉 。 

(3) 机 械 系 统 ” 该 系统 一 般 包 括 机 映 、 辟 部 、 手 腕 、 末 端 操作 器 (也 称 为 手 部 ) 和 行 
走 机 构 等 部 分 ， 每 一 部 分 都 有 若干 自由 度 ， 构 成 一 个 多 自由 度 的 机 械 系 统 。 若 机 器 人 具备 行 
走 机 构 ， 则 构成 行走 机 器 人 ; 若 机 器 人 不 具备 行走 机 构 ， 则 构成 固定 式 机 器 人 。 末 端 操作 器 
是 装 在 手腕 上 的 一 个 重要 部 件 ， 它 可 以 是 两 手指 或 多 手指 的 手 扑 ， 也 可 以 是 喷涂 枪 、 焊 枪 等 
作业 工具 。 机 械 系统 的 作用 相当 于 人 的 身体 〈 骨 骼 、 手 、 臂 和 腿 等 ) 。 

(4) 检测 系统 ”该 系统 由 内 部 传 感 颖 和 外 部 传感器 等 组 成 ， 其 作用 是 获取 机 器 人 内 部 
和 外 部 环境 信息 ， 并 把 这 些 信息 反 馈 给 控制 系统 。 内 部 状态 传感器 用 于 检测 各 关节 的 位 置 、 
速度 等 信息 。 外 部 状态 传感器 用 于 检测 机 器 人 与 周围 环境 之 间 的 一 些 状态 信息 ， 如 距离 、 接 
近 程 度 和 接触 情况 等 ， 用 于 引导 机 器 人 ， 便 于 其 识别 物体 并 做 出 相应 处 理 ， 赋 予 机 器 人 一 定 
的 智能 。 该 部 分 的 作用 相当 于 人 的 五 官 。 

1.2.3 机 器 人 的 技术 参数 

技术 参数 是 机 器 人 制造 商 在 产品 供 货 时 所 提供 的 技术 数据 ， 反 映 了 机 器 人 可 胜任 的 工作 、 
具有 的 操作 性 能 等 情况 ， 是 选择 、 设 计 、 应 用 机 器 人 时 必须 考虑 的 数据 。 机 器 人 的 主要 技术 参 
数 一 般 有 自由 度 、 定 位 精度 、 重 复 定位 精度 、 工 作 空间 、 承 载 能 力 及 最 大 工作 速度 等 。 

(1) 自由 度 ”机 器 人 自由 度 是 指 其 所 具有 的 独立 运动 的 数目 ， 一 般 不 包括 末端 操作 器 
的 开 合 自由 度 。 机 器 人 的 一 个 自由 度 通常 对 应 一 个 关节 的 独立 运动 。 自 由 度 是 表示 机 器 人 动 
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作 灵 活 程度 的 参数 ， 自 由 度 越 多 机 器 人 就 越 灵 活 ， 但 结构 也 就 越 复杂 ， 控 制 难度 武大， 所 以 
机 器 人 的 自由 度 要 根据 其 用 途 设 计 ， 一 般 在 3~6 个 之 间 。 大 于 6 个 的 自由 度 称 为 元 余 自 由 
度 。 宛 余 自由 度 增加 了 机 器 人 的 灵活 性 ， 可 方便 机 器 人 躲避 障碍 物 和 改善 机 器 人 的 动力 性 
能 。 人 类 的 手臂 〈 大 臂 、 小 臂 和 手腕 ) 共有 7 个 自由 度 ， 一 个 人 的 一 只 手 5 个 手指 共有 24 
个 自由 度 ， 所 以 工作 起 来 很 灵巧 ， 可 回避 障碍 物 ， 并 可 从 不 同方 向 到 达 同 一 个 目的 点 。 

(2) 定位 精度 和 重复 定位 精度 ”定位 精度 和 重复 定位 精度 是 机 融 人 的 两 个 精度 指标 。 
定位 精度 是 指 机 絮 人 末端 操作 器 的 实际 位 置 与 目标 位 置 之 间 的 偏差 ， 由 机 械 误差 、 控 制 算 法 
误差 与 系统 分 辨 率 等 部 分 组 成 。 

重复 定位 精度 是 指 在 环境 、 条 件 、 目 标 动作 和 命令 等 相同 的 条 件 下 ， 机 器 人 连续 重复 运 
动 若 干 次 时 ， 其 位 置 的 分 散 情 况 。 因 重复 定位 精度 不 受 工作 载荷 变化 的 影响 ， 故 通常 用 重 
定位 精度 指标 作为 衡量 示 教 一 再 现 式 机 器 人 水 平 的 重要 指标 。 

(3) 工作 空间 工作 空间 表示 机 器 人 的 工作 范围 ， 它 是 机 器 人 运动 时 手腕 中 心 点 所 能 达 
到 的 所 有 点 的 集合 ， 也 称 为 工作 区 域 。 由 于 末端 操作 器 的 形状 和 尺寸 是 多 种 多 样 的 ， 为 真实 反 
映 机 器 人 的 特征 参数 ， 故 工作 空间 是 指 不 安装 末端 操作 器 时 的 工作 区 域 。 工 作 空间 的 大 小 不 仅 
与 机 器 人 各 连 杆 的 尺寸 有 关 ， 而 且 与 机 器 人 的 总 体 结构 形式 有 关 。 工 作 空间 的 形状 和 大 小 是 十 
分 重要 的 ， 机 器 人 在 执行 某 作 业 时 可 能 会 因 存在 手 部 不 能 到 达 的 作业 死 区 而 不 能 完成 任务 。 

(4) 最 大 工作 速度 “生产 机 融 人 的 三 家 不 同 ， 其 所 指 的 最 大 工作 速度 也 不 同 。 有 的 广 家 
唱机 器 人 主要 自由 度 上 最 大 的 稳定 速度 ， 有 的 三 家 指 手臂 末端 最 大 的 合成 速度 ， 通 囊 都 会 在 技 
术 参 数 中 加 以 说 明 。 最 大 工作 速度 越 高 ， 工 作 效 率 越 高 。 但 是 ， 工 作 速 度 越 高 就 要 花费 较 多 的 
时 间 加 速 或 减速 ， 或 者 对 机 器 人 的 最 大 加 速率 或 最 大 减速 率 的 要 求 更 高 。 

(5) 承载 能 力 ”承载 能 力 是 指 机 器 人 在 工作 范围 内 的 任意 位 次 上 ， 所 能 承受 的 最 大 载 
和 荷 。 承 载 能力 不 仅 取决 于 负载 的 大 小 ， 而 且 与 机 器 人 运行 的 速度 和 加 速度 有 关 。 为 保证 安全 
起 见 ， 将 承载 能 力 这 一 技术 指标 确定 为 高 速 运行 时 的 承载 能 力 。 通 常 ， 承 载 能 力 不 仅 指 负载 
载 集 ， 而 且 包 括 机 如 人 末端 操作 融 的 重力 。 


1.3 机 各 人 的 分 类 


机 絮 人 的 分 类 方法 很 多 ， 下 面 依据 几 个 有 代表 性 的 分 类 方法 列举 机 絮 人 的 分 类 。 

1. 按照 应 用 类 型 分 类 

机 器 人 按 应 用 类 型 可 分 为 工业 机 融 人 、 极 限 作业 机 融 人 和 娱乐 机 器 人 。 

(1) 工业 机 絮 人 ”是 指 用 于 工业 领域 的 机 右 人 ， 如 搬运 、 焊 接 、 装 配 、 噶 涂 和 检查 等 
机 和 华人。 

(2) 极限 作业 机 器 人 主要 是 指 在 人 们 难以 进入 的 核电 站 、 海 底 和 宇宙 空间 等 进行 作 
业 的 机 各 人 。 

(3) 娱乐 机 器 人 “主要 是 指 用 于 娱乐 的 机 器 人 。 包 括 弹 奏 乐 器 的 机 器 人 、 舞 蹈 机 顺 人 
和 玩具 机 器 人 等 〈 具 有 某 种 程度 的 通用 性 ) 。 

2. 按 机 器 人 发 展 的 程度 分 类 

按照 从 低级 到 高 级 的 发 展 程度 来 分 ， 机 器 人 一 般 可 分 为 以 下 几 类 。 

(1) 第 一 代 机 器 人 是 指 只 能 以 “ 示 教 一 再 现 ”方式 工作 的 机 器 人 。 
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(2) 第 二 代 机 器 人 带 有 一 些 可 感知 环境 的 检测 装置 ， 可 通过 反馈 控制 ， 使 其 在 一 定 
程度 上 适应 变化 的 环境 。 

(3) 第 三 代 机 器 人 属于 智能 机 器 人 。 它 具有 多 种 感知 功能 ， 可 进行 复杂 的 逻辑 推理 、 
判断 及 决策 ， 可 在 作业 环境 中 独立 行动 ， 具 有 发 现 问 题 ， 并 能 自主 地 解决 问题 的 能 力 。 这 类 
机 器 人 具有 高 度 的 适应 性 和 自治 能 力 。 

(4) 第 四 代 机 器 人 “为 情感 型 机 器 人 。 它 具有 人 类 式 的 情感 。 具 有 情感 是 机 器 人 发 展 
的 较 高 层次 ， 也 是 机 器 人 科学 家 的 梦想 。 

3. 按照 控制 方式 分 类 

机 器 人 按 控制 方式 可 分 为 操作 机 器 人 、 程 序 机 器 人 、 示 教 再 现 机 器 人 、 智 能 机 器 人 和 综 
合 机 器 人 。 

(1) 操作 机 器 人 ”操作 机 器 人 的 典型 代表 是 在 核电 站 处 理 放 射 性 物质 时 远 距离 进行 操 
作 的 机 器 人 。 在 这 种 场合 ， 相 当 于 人 手 操纵 的 部 分 称 为 主动 机 械 手 ， 而 从 动机 械 手 基本 上 与 
主动 机 械 手 类 似 ， 只 是 从 动机 械 手 要 比 主动 机 械 手 大 一 些 ， 作 业 时 的 力量 也 更 大 。 

(2) 程序 机 器 人 程序 机 器 人 按 预先 给 定 的 程序 、 条 件 和 位 置 进行 作业 ， 目 前 大 部 分 
机 需 人 都 采用 这 种 控制 方式 工作 。 

(3) 示 教 再 现 机 器 人 “ 示 教 再 现 机 器 人 与 盒 式 磁带 的 录放 一 样 ， 将 所 教 的 操作 过 程 自 
动 记录 在 软盘 、 磁 带 等 存储 器 中 ， 当 需要 再 现 操 作 时 ， 可 重复 所 教 过 的 动作 过 程 。 示 教 方法 
有 手把手 示 教 、 有 线 示 教 和 无 线 示 教 。 

(4) 智能 机 器 人 智能 机 器 人 不 仅 可 以 进行 预先 设 定 的 动作 ， 还 可 以 按照 工作 环境 的 
变化 改变 动作 。 

(5) 综合 机 器 人 综合 机 器 人 是 由 操作 机 器 人 、 示 教 再 现 机 器 人 、 智 能 机 器 人 组 合 而 
成 的 机 器 人 ， 如 火星 探测 机 器 人 。 

4. 按 机 器 人 关节 连接 布置 形式 分 类 

按 机 器 人 关节 连接 布置 的 形式 ， 机 器 人 可 分 为 串联 机 器 人 和 并 联机 器 人 两 类 。 

串联 机 器 人 的 杆 件 和 关节 是 采用 串联 方式 进行 连接 ( 开 链 式 ) 的 ， 并 联机 器 人 的 杆 件 
和 关节 是 采用 并 联 方式 进行 连接 ( 闭 链 式 ) 的 。 

并 联机 器 人 是 指 运动 平台 和 基 座 间 至 少 由 两 根 活 动 连 杆 连接 ， 具 有 两 个 或 两 个 以 上 自由 
度 闭 环 机 构 的 机 器 人 。 并 联机 器 人 具有 刚度 和 精度 高 、 响 应 速度 快 、 结 构 简单 等 特点 ， 其 不 
足 之 处 在 于 工作 空间 小 和 控制 较 复 杂 。 并 联机 器 人 广泛 用 于 产品 包装 、 飞 行 员 训 练 模 拟 及 外 
科 手 术 设备 的 精确 定位 等 。 

5. 按照 机 器 人 坐标 形式 分 类 
通 和 将 机 器 人 机 喘 、 臂 部 、 手 脏 和 末端 操作 器 〈 如 手 爪 ) 称 为 机 器 人 的 操作 臂 ， 它 由 
一 系列 的 连 杆 通过 关节 顺序 串联 而 成 。 关 节 决 定 两 相 邻 连 杆 副 之 间 的 连接 关系 ， 也 称 为 运动 
副 。 机 右 人 最 常用 的 两 种 关节 是 移动 关节 (Prismatic joint) 和 转动 关节 (Revolute joint ) ， 
通常 用 P 表示 移动 关节 ， 用 R 表示 转动 关节 。 

机 器 人 要 完成 任 一 空间 作业 ， 通 常 需要 6 个 自由 度 。 机 器 人 的 运动 由 臂 部 和 手腕 的 运动 
组 合 而 成 。 通 常 臂 部 有 3 个 关节 ， 用 于 改变 手腕 参考 点 的 位 置 ， 称 为 定位 机 构 ; 手腕 部 分 也 
有 3 个 关节 ， 通 常 这 3 个 关节 的 轴线 相互 王 直 相交 ， 用 来 改变 末端 操作 器 的 姿态 ， 称 为 定向 
机 构 。 整 个 操作 臂 可 以 看 成 是 由 定位 机 构 连接 定向 机 构 组 成 的 。 
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机 器 人 操作 臂 的 关节 通常 为 单 自由 度 主动 运动 副 ， 即 每 一 个 关节 均 由 一 个 驱动 器 驱动 。 

机 器 人 臂 部 3 个 关节 的 种 类 决定 了 操作 臂 工作 空间 的 形式 。 按 照 臂 部 关节 沿 坐 标 轴 的 运 
动 形式 ， 即 按 移动 和 转动 的 不 同 组 合 ， 可 将 机 器 人 分 为 直角 坐标 型 、 圆 柱 坐 标 型 、 球 〈 极 ) 
坐标 型 、 关 节 坐 标 型 和 平面 关节 型 五 种 类 型 。 机 器 人 的 结构 形式 由 用 途 决 定 ， 即 由 所 完成 工 
作 的 性 质 选取 。 

(1) 直角 坐标 型 机 器 人 直角 坐标 型 机 器 人 的 外 形 与 数控 铀 铣床 和 三 坐标 测量 机 相似 ， 
如 图 1-4a 所 示 。 其 中 3 个 关节 都 是 移动 关节 (3P) ， 关 节 轴 线 之 间 相 互 垂直 ， 相 当 于 笛 卡 
儿 坐 标 系 的 对 轴 、Y 轴 和 Z 轴 。 其 优点 是 刚度 好 。 大 多 做 成 大 型 龙门 式 或 框架 式 结 构 ， 位 置 
精度 高 、 运 动 学 求解 简单 、 控 制 无 耦合 ; 但 其 结构 较 庞大 、 动 作 范 围 小 、 灵 活性 差 ， 并 且 占 
地 面积 较 大 。 因 其 稳定 性 好 ， 适 用 于 大 负载 搬 送 作业 。 

(2) 圆柱 坐标 型 机 融 人 ”圆柱 坐标 型 机 器 人 具有 2 个 移动 关节 (2P) 和 1 个 转动 关节 
(1R) ， 工 作 范 围 为 圆柱 形状 ， 如 图 1-4b 所 示 。 其 特点 为 位 置 精度 高 、 运 动 直观 、 控 制 方便 、 
结构 简单 、 占 地 面积 小 和 价格 低廉 ， 因 此 应 用 广泛 ; 但 其 不 易 抓 取 靠 近 立 柱 或 地 面 上 的 物体 。 


































































































图 1-4 机 器 人 按 坐标 形式 分 类 示意 图 
a) 直角 坐标 型 b) 圆柱 坐标 型 c) 球 〈( 极 ) 坐标 型 d) 关节 坐标 型 e) 平面 关节 型 



































(3) 球 〈 极 ) 坐标 型 机 器 人 球 ( 极 ) 坐标 型 机 带 人 具有 1 个 移动 关节 (1P) 和 2 个 
转动 关节 (2R) ,工作 范围 为 球体 形状 ， 如 图 1-4e 所 示 。 其 优点 是 结构 紧凑 、 动 作 灵 活 、 
占 地 面积 小 ， 但 其 结构 复杂 、 定 位 精度 低 、 运 动 直观 性 差 。 

(4) 关节 坐标 型 机 器 人 “关节 坐标 型 机 器 人 由 立柱 、 大 臂 和 小 臂 组 成 。 其 具有 拟人 的 
机 械 结构 ， 即 大 臂 与 立柱 构成 肩 关 节 ， 大 臂 与 小 臂 构成 肘 关 节 。 有 具有 3 个 转动 关节 (3R ) ， 
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可 进一步 分 为 1 个 转 劲 关节 和 2 个 俯仰 关节 ， 工 作 范围 为 球体 形状 ， 如 岁 1-4d 所 示 。 该 类 
机 带 人 的 特点 是 工作 范围 大 、 动 作 灵 活 、 能 抓 取 靠近 机 身 的 物体 ;运动 直观 性 差 ， 要 得 到 高 
定位 精度 较 困 难 。 由 于 该 类 机 器 人 灵活 性 高 ， 其 应 用 较 广 泛 。 

(5) 平面 关节 型 机 融 人 ”该 机 器 人 有 3 个 转动 关节 ， 其 轴线 相互 平行 ， 可 在 平面 内 进 
行 定位 和 定向 ; 该 机 器 人 还 有 1 个 移动 关节 ， 用 于 完成 手 爪 在 垂直 于 平面 方向 的 运动 ， 如 图 
1-4e 所 示 。 手 腕 中 心 的 位 置 由 2 个 转动 关节 及 1 个 移动 关节 来 决定 ， 手 爪 的 方向 由 转动 关 
节 的 角度 来 决定 。 该 类 机 器 人 的 特点 是 在 垂直 平面 内 具有 很 好 的 刚度 ， 在 水 平面 内 具有 较 好 
的 柔顺 性 ， 动 作 灵 活 、 速 度 快 、 定 位 精度 高 。 该 机 絮 人 较 适 宜 于 平面 定位 ， 在 垂直 方向 进行 
装配 ， 所 以 又 称 为 装配 机 器 人 。 


1.4 机 器 人 涉及 的 相关 理论 及 技术 


机 器 人 技术 属于 一 个 多 学 科 和 技术 交叉 融合 的 高 技术 领域 。 机 器 人 是 具有 感知 、 思 维和 
行动 功能 的 自动 化 机 器 ， 是 机 构 学 、 测 斌 技术、 制造 技术 、 上 自动 控制 、 计 算 机 、 人 工 智 能 、 
微 电 子 学 、 光 学 、 通 信 技 术 、 传 感 技术 、 仿 生 学 等 多 种 学 科 和 技术 的 综合 成 果 。 本 节 简 要 介 
绍 机 器 人 涉及 的 相关 理论 及 技术 。 


1.4.1 机 器 人 涉及 的 基础 理论 


机 器 人 学 是 研究 机 絮 人 设计 、 制 造 和 应 用 的 学 科 ， 也 是 一 门 交叉 性 很 强 的 学 科 。 它 所 涉 
及 的 基础 学 科 也 很 广泛 ， 包 括 数学 、 运 动 学 、 动 力学 、 控 制 理论 以 及 人 工 智能 等 。 从 理论 应 
用 的 角度 ， 主 要 有 以 下 几 个 方面 。 

(1) 机 器 人 基础 理论 与 方法 ”包括 机 器 人 机 构 分 析 与 综合 、 运 动 学 和 动力 学 建 模 、 作 
业 与 运动 规划 、 机 器 人 优化 设计 、 上 自动 控制 和 智能 化 等 。 

(2) 机 器 人 仿生 学 ”包括 仿生 运动 学 和 动力 学 、 仿 生机 构 学 、 仿 生 感 知 和 控制 理论 、 
仿生 器 件 设计 和 制造 等 。 

(3) 机 器 人 系统 理论 包括 多 机 器 人 系统 理论 、 机 器 人 与 人 融合 ， 以 及 机 器 人 与 其 他 
机 械 系 统 的 协调 和 交互 。 

(4) 微机 器 人 学 ”包括 微机 器 人 的 分 析 、 设 计 和 控制 理论 等 。 

(5) 移动 操作 机 器 人 理论 ”包括 复杂 多 链 空 间 机 带 人 机 构 学 、 步 态 规 划 与 稳定 性 、 多 
链 协 调 与 控制 等 。 


1.4.2 机 器 人 涉及 的 技术 

机 器 人 同时 也 是 一 门 实践 性 很 强 的 学 科 ， 所 涉及 的 技术 主要 有 机 器 人 结构 设计 与 制造 技 
术 、 操 作 和 执行 技术 、 驱 动 和 控制 技术 、 检 测 和 感知 技术 、 机 器 人 智能 技术 、 试 验 和 评价 技 
术 、 人 机 交互 和 融合 技术 、 通 信 技 术 等 。 
1.5 课程 学 习 导 引 


本 书 共 分 为 8 章 。 
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第 1 章 为 绪论 ， 介 绍 机 器 人 及 其 技术 的 发 展 、 定 义 、 特 征 、 结 构 、 技 术 参 数 和 分 类 ， 以 
及 机 器 人 涉及 的 主要 理论 和 技术 等 内 容 。 

第 2 章 为 机 如 人 机 械 系统 。 该 章 主 要 介绍 机 器 人 的 机 座 、 手 部 、 腕 部 、 辟 部、 驱动 和 传 
动机 构 等 的 工作 原理 、 绪 构 特 点 和 设计 要 求 。 通 过 本 章 的 学 习 ， 能 够 了 解 和 掌握 机 器 人 的 机 
械 系统 一 般 结构 、 工 作 原 理 和 设计 要 点 。 

第 3 章 为 机 器 人 数学 基础 。 该 章 首 先 介绍 关于 位 置 、 姿 态 和 章 次 坐标 的 概念 ， 然 后 介绍 
平移 和 旋转 的 定义 ， 以 及 平移 和 旋转 的 相关 知识 ; 还 介绍 了 章 次 变换 矩阵 ， 给 出 了 齐 次 变换 
和 矩阵 的 相关 定义 。 

第 4 章 为 机 器 人 运动 学 。 该 章 介 绍 几 种 典型 机 咒 人 的 正道 运动 方程 建立 及 分 析 ; 还 介绍 
机 器 人 的 雅 可 比 矩 阵 的 建立 ， 包 括 速度 雅 可 比 和 矩阵 和 力 雅 可 比 矩 阵 ; 同时 对 机 器 人 奇异 点 和 
奇异 位 形 进行 分 析 和 研究 。 

第 5 章 为 机 器 人 动力 学 。 该 章 主 要 介绍 机 器 人 的 静 力 学 问题 、 动 力学 问题 ， 以 及 动力 学 建 
模 和 仿真 。 为 了 建立 机 器 人 动力 学 方程 ， 首 先 讨论 机 器 人 运动 的 瞬时 状态 ， 对 其 进行 速度 分 析 
和 加 速度 分 析 ， 研 究 连 杆 的 受 力 状 态 ， 然 后 利用 达 朗 贝尔 等 原理 ， 解 决 动力 学 分 析 问 题 。 

第 6 章 为 机 器 人 控制 系统 。 该 章 首 移 介 绍 机 器 人 控制 系统 的 一 般 形 式 和 特点 ， 分 析 机 天 
人 控制 中 较 基本 的 位 置 控 制 问题 ， 从 分 析 单 关节 位 置 控 制 的 传递 函数 入 手 ， 建 立 了 单 关 节 位 
置 控制 器 ， 分 析 控 制 器 参数 确定 及 系统 的 误差 问题 ; 在 机 器 人 运动 控制 系统 一 节 ， 以 LM629 
控制 卡 为 例 ， 对 机 器 人 的 运动 控制 做 了 分 析 ; 以 基于 PC 的 教学 机 器 人 控制 系统 为 例 ， 介 绍 
了 该 教学 机 器 人 实验 平台 的 总 体 控制 方案 。 

第 7 章 为 机 器 人 轨迹 规划 。 该 章 讲述 关于 轨迹 规划 的 一 般 性 问题 ， 并 且 对 关节 轨迹 规划 
的 插值 和 笛 卡 儿 空 间 的 规划 方法 做 了 介绍 。 

第 8 章 为 机 器 人 设计 方法 和 应 用 及 其 发 展 。 该 章 主 要 介绍 了 机 器 人 设计 的 一 般 原 则 、 方 
法 和 步骤 ， 分 析 了 工业 机 器 人 和 特种 机 器 人 的 设计 实例 。 简 要 地 介绍 了 机 器 人 的 应 用 和 发 展 
现状 ， 分 析 了 机 器 人 与 人 类 之 间 的 关系 。 本 音 的 目的 在 于 使 读者 对 机 融 人 的 应 用 和 发 展 有 一 
个 整体 的 认识 ， 为 应 用 和 研究 机 器 人 提供 理论 支撑 。 



































1.6 ”本章 小 结 


本 章 介绍 了 机 器 人 发 展 历程 ， 阐 述 了 机 器 人 的 定义 、 特 征 、 结 构 组 成 、 分 类 及 技术 参数 
等 问题 ， 其 目的 在 于 使 读者 对 机 器 人 的 基本 知识 有 一 个 初步 的 了 解 ， 为 后 续 学 习 、 应 用 和 研 
究 机 器 人 打下 一 个 恨 好 的 基础 。 








习题 


1-1 简 述 机 器 人 的 发 展现 状 。 
1-2 机 器 人 设计 的 三 原则 是 什么 ? 
1-3 机 器 人 按 应 用 类 型 来 分 ， 可 分 为 哪 几 类 ? 机 器 人 的 技术 参数 主要 有 哪些 ? 











机 器 人 的 机 械 系统 是 机 器 人 的 支承 基础 和 执行 机 构 ， 主 要 包括 末端 操作 器 ( 手 部 ) 1、 腕 
部 2、 篆 部 3、 腰 部 4 和 机 座 5 等 ， 如 图 2-1 所 示 。 其 机 械 系 统 是 机 器 人 设计 的 重要 内 容 之 一 。 
使 用 要 求 是 机 器 人 机 械 系 统 设计 的 出 发 点 ， 优 质 、 高 效 和 低 成 本 是 其 设计 追求 的 目标 。 
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图 2-1 工业 机 器 人 结构 示意 图 
1 一 末端 操作 器 〈 手 部 ) ”2 一 胶 部 
3 一 辟 部 4 一 腰部 5 一 机 座 
本 章 主 要 介绍 机 器 人 的 机 座 、 末 端 操作 器 ( 手 部 )、 腕 部 、 辟 部 、 了 驱动 和 传动 机 构 等 的 
工作 原理 、 结 构 特点 和 设计 要 求 。 通 过 本 章 的 学 习 ， 使 读者 能 够 了 解 和 掌握 机 器 人 的 机 械 系 
统一 般 结构 、 工 作 原理 和 设计 要 点 。 


2.1 机 需 人 的 机 座 









































2.1.1 概述 


机 器 人 的 机 座 ， 可 以 分 为 固定 式 和 行走 式 两 种 。 一 般 的 机 器 人 机 座 大 多 是 固定 式 的 ， 还 
有 一 部 分 是 移动 式 的 。 随 着 科学 技术 发 展 的 需要 ， 具 有 一 定 智 能 的 可 移动 的 行走 式 机 器 人 将 
是 今后 机 器 人 发 展 的 方向 之 一 ， 并 将 得 到 广泛 地 应 用 。 

根据 机 器 人 的 行走 环境 ， 可 将 机 器 人 所 具备 的 移动 机 能 分 为 以 下 几 类 : 中 地 面 移 动机 
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; @@ 水 中 移动 机 能 ;图 空中 移动 机 能 ;图 地 中 移动 机 能 等 。 本 节 主要 介绍 具有 地 面 行走 机 
9 行走 机 构 。 根 据 地 面 行走 机 构 的 特点 可 以 将 其 分 为 车 轮 式 、 履 带 式 和 步行 式 三 种 行走 机 
构 ， 它 们 在 行走 过 程 中 ， 前 两 者 与 地 面 连 续 接触 ， 目 形态 为 运行 车 式 ， 后 者 为 间断 接触 ， 形 
态 为 类 人 或 动物 的 腿脚 式 。 


2. 1.2 车 轮 式 行走 机 构 


车 轮 式 行 走 机 构 具 有 运动 平稳 、 能 耗 小 ， 以 及 容易 控制 移动 速度 和 方向 等 优点 ， 因 此 得 
到 普遍 的 应 用 。 目 前 应 用 较 广 的 主要 是 三 轮 式 和 四 轮 式 行走 机 构 。 

三 轮 式 行走 机 构 具 有 一 定 的 稳定 性 ， 其 设计 难点 是 移动 方向 的 控制 。 典 型 车 轮 的 配置 方 
法 是 一 个 前 轮 和 两 个 后 轮 ， 由 前 轮作 为 操纵 舵 来 改变 方向 ， 后 轮 (或 前 轮 ) 驱动 ;为 一 种 
配置 方法 是 ， 用 后 面 两 轮 独立 驱动 ， 前 轮 仅 起 支承 作用 ， 并 靠 两 后 轮 的 转速 差 来 改变 运动 方 
向 。 图 2-2 所 示 为 三 轮 式 行走 和 转弯 机 构 示 意图 ， 图 2-2a 所 示 为 由 一 个 驱动 轮 和 转向 机 构 
来 转弯 ， 图 2-2b 所 示 为 由 两 个 驱动 轮转 速 差 来 转弯 。 
四 轮 式 行 走 机 构 也 是 一 种 应 用 较 广 的 移动 方式 ， 其 优点 是 承重 量 大 、 稳 定性 好 ， 四 个 轮 
子 要 求 同 时 着 地 。 图 2-3 所 示 为 四 轮 式 行 走 和 转 论 机 构 示 意图 。 图 2-3a、b 所 示 是 两 个 驱动 
轮 和 两 个 自 位 轮 的 机 构 ; 图 2-3c 所 示 是 和 汽车 类 型 相同 的 移动 机 构 ， 为 了 转向 ， 采 用 四 连 
杆 机 构 ， 回 转 中 心 大 致 在 后 轮 车 轴 的 延长 线 上 ; 图 2-3d 所 示 可 以 独立 地 进行 左右 转向 ， 因 
而 可 以 提高 回转 精度 ; 图 2- 3e 所 示 为 全 部 轮子 都 可 以 进行 转向 ， 能 够 减 小 转弯 半径 。 
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图 2-3 四 轮 式 行走 和 转弯 机 构 示 意图 

a) 两 个 驱动 轮 和 两 个 自 位 轮 b) 两 个 驱动 轮 和 两 个 自 位 轮 c) 一 个 驱动 系统 和 转向 轮 
d) 一 个 驱动 系统 和 两 个 转向 轮 。) 全 部 轮 都 装 有 转向 机 构 
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在 四 轮 式 行走 机 构 中 ， 自 位 轮 沿 回转 轴线 回转 ， 直 到 转 到 转弯 方向 为 止 ， 这 期 间 驱 动 轮 
产生 滑动 ， 因 而 很 难 求 出 正确 的 移动 量 。 男 外 ， 在 用 转向 机 构 改 变 运动 方向 时 ,缺点 是 在 静 
止 状态 下 会 产生 较 大 的 阻力 。 


2. 1.3 履带 式 行走 机 构 


履带 式 行走 机 器 人 如 图 2-4 所 示 。 它 不 仅 可 以 在 凸 四 不 平 的 地 面 上 行走 ， 而 且 可 以 跨越 
障碍 物 ， 能 候 一 定 的 台阶 等 。 

类 似 于 坦克 式 的 履带 式 机 器 人 ， 由 于 没有 上 自 位 轮 ， 没 有 转向 机 构 ， 要 转弯 只 能 靠 左 右 两 
个 履带 的 速度 差 ， 所 以 不 仅 在 横向 ， 而 且 在 前 进 方向 也 会 产生 滑动 ， 转 弯 阻 力 大 ， 不 能 准确 
地 确定 回转 半径 等 。 

形状 可 变 式 履带 行走 机 构 如 图 2-5 所 示 。 该 履带 形状 可 以 适应 台阶 形状 而 改变 ， 比 一 般 
履带 式 机 器 人 的 动作 更 为 灵活 。 
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图 2-4 履带 式 行走 机 器 人 示意 图 图 2-5 形状 可 变 式 履 带 行 走 机 构 示意 图 





2. 1.4 步行 式 行走 机 构 


类 似 于 人 或 动物 那样 ， 利 用 脚 部 关节 机 构 ， 用 步行 方式 ， 实 现 移 动 的 机 械 ， 称 为 步行 机 
构 。 步 行 机 器 人 采用 步行 机 构 ， 其 特征 是 不 仅 能 够 在 凸凹 不 平 的 地 上 行走 、 路 越 沟 黎 、 上 下 
台阶， 而 且 具 有 广泛 的 适应 性 ， 但 控制 上 具有 一 定 的 难度 。 步 行 机 构 有 两 足 、 三 足 、 四 足 、 
六 足 和 八 足 等 形式 ， 其 中 两 足 步行 机 构 具 有 较 好 的 适应 性 ， 也 最 接近 人 类 ， 故 又 称 为 类 人 双 
足 行走 机 构 。 

(1) 两 足 步行 机 构 ”两 足 步行 机 构 是 多 自由 度 的 系统 ， 结 构 较 简单 ， 但 其 静 、 动 行走 
性 能 及 稳定 性 和 高 速 运动 性 能 都 很 难 实现 。 如 图 2-6 所 示 ， 两 足 步行 机 器 人 行走 机 构 是 一 空 
间 连 杆 机 构 。 在 行走 过 程 中 ,行走 机 构 始 终 满足 静 力 学 的 静 平 衡 条 件 , 也 就 是 机 器 人 的 重心 
始终 落 在 文 持 地面 的 一 只 脚 上 。 

两 足 步行 机 器 人 的 动 步行 有 效 地 利用 了 惯性 力 和 重力 。 人 的 步行 就 是 动 步行 ， 动 步行 的 
典型 例子 是 踩 高 跷 。 高 跷 与 地 面 只 是 单 点 接触 ， 两 根 高 跷 不 动 时 在 地 面 站 稳 是 非常 困难 的 ， 
要 想 原 地 停留 ， 必 须 不 断 踏 步 ， 不 能 总 是 保持 步行 中 的 某 种 瞬间 姿态 。 

从 国内 外 研究 的 较为 成 熟 的 两 足 步 行 机 咒 人 来 看 ， 几 乎 所 有 的 两 足 步 行 机 器 人 腿 部 都 选 
择 6 自由 度 的 方式 〈 见 图 2-7) ， 其 分 配方 式 为 : 通关 3 个 自由 度 、 膝 关节 1 个 自由 度 、 
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躁 关 节 2 个 自由 度 。 由 于 躁 关节 缺少 了 一 个 旋转 自由 度 ， 当 机 器 人 行走 中 进行 转弯 时 ， 只 能 
依靠 大 腿 与 上 身 连接 处 的 旋转 来 实现 ， 需 要 先决 定 转 过 的 角度 ， 并 且 需 要 更 多 的 步 数 来 完成 
行走 转弯 这 个 动作 。 但 是 这 样 的 设计 可 以 降低 踩 关节 的 设计 复杂 程度 ， 有 利于 躁 关节 的 机 构 
布置 ， 从 而 减 小 机 构 的 空间 体积 ， 减 小 下 肢 的 质量 。 几 种 两 足 步 行 机 器 人 下 肢 关节 驱动 方式 
比较 见 表 2- 1。 
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电动 机 PY=p 
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图 2-6 两 足 步 行 机 器 人 行走 机 构 示 意图 图 2-7 腿 部 6 个 自 
由 度 的 分 配 示意 图 
表 2-1 几 种 两 足 步行 机 器 人 下 肢 关节 驱动 方式 比较 
机 器 人 名 称 研究 机 构 驱动 方式 机 器 人 质量 动力 源 
ASIMO Honda 公司 伺服 电动 机 、 谐 波 减速 器 43kg 38V/10A 电池 
HRP-2 日 本 METI 伺服 电动 机 、 谐 波 减 速 右 58kg 48V/18AH 
WABIAN 早稻 田 大 学 直流 伺服 电动 机 50kg NI-H 电池 
BIP2000 法 国 直流 电动 机 滚动 丝 杠 连 杆 结构 40kg 不 详 
M2 MIT 直流 电动 机 、 平 行 弹簧 阻尼 滚动 丝 杠 结构 不 详 不 详 
THBIP-1 清华 大 学 直流 电动 机 ,滚珠 丝 杠 和 曲柄 连 杆 减速 机 构 不 详 Ni- MH 莱 电池 


(2) 四 足 步行 机 构 ” 四 足 步 行 机 构 静 止 状 态 是 稳定 的 ， 具备 一 切 步 行 机 器 人 的 优点 ， 
所 以 它 和 六 足 步 行 机 构 一 样 具 有 一 定 的 实用 性 。 四 足 步行 机 构 在 步行 中 ， 当 一 只 脚 抬 起 ， 三 
只 脚 支 承 自 重 时 ， 有 必要 移动 身体 ， 让 重心 移动 到 三 只 脚 着 地 点 所 组 成 的 三 角形 内 。 各 脚 相 
应 其 支点 提起 、 向 前 伸 出 、 接 地 、 水 平 向 后 返回 ， 像 这 样 一 连 串 动作 均 可 由 连 杆 机 构 来 完 
成 ， 不 需要 特别 的 控制 。 然 而 为 了 适应 凸凹 不 平 的 地 面 ， 每 只 脚 至 少 要 有 2 个 自由 度 ， 图 
2-8a 所 示 是 四 足 步 行 机 构 的 例子 。 图 2-8b 是 平移 与 平移 间 的 变换 ， 由 于 是 缩放 机 构 ， 脚 尖 
的 位 置 容易 计算 。 要 实现 步行 方向 的 改变 和 上 下 台阶 ,各 只 脚 只 要 有 3 个 自由 度 就 足够 了 。 

(3) 六 足 步行 机 构 “六 足 步 行 机 构 的 静 稳 定 步行 图 如 图 2-9 所 示 。 从 图 中 可 以 看 到 ， 
为 了 保持 机 体 以 更 稳定 性 的 状态 向 前 移动 ， 首 先 由 4、B、C 三 只 脚 处 于 立 脚 相 , 支承 着 机 
体 的 重量 ,使 重心 6 在 和 人 4BC 内 ， 如 图 2-9a 所 示 ; 而 D、E、 了 三 只 脚 处 于 游 脚 相 ， 向 前 方 
位 置 移动 ， 当 D、E、F 三 只 脚 移动 预定 步 长 ， 到 达 位 置 D'、E'、KF'， 并 接触 地 面 时 ， 与 4、 
B、C 三 只 脚 同 时 支持 着 体重 ， 重 心 自然 前 移 ， 如 图 2-9b 所 示 ; 随 着 4、B、C 三 只 脚 的 提 
起 ， 变 为 游 脚 相 时 ,体重 完 全 由 D、E、F 三 只 肢 支 承 ， 如 图 2-9c 所 示 ; 重心 6 继续 向 前 
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图 2-8 四 足 步行 机 构 举 例 


移 ， 而 4、B、C 三 只 脚 则 向 4'、B'、C ' 处 移动 ， 如 图 2-9d 所 示 。 这 样 六 只 脚 交 蔡 着 步行 ， 
始终 保持 最 少 有 三 只 脚 着 地 ， 而 机 体重 心 则 始终 在 所 支承 的 三 只 脚 所 形成 的 三 角形 内 ， 从 而 
保持 着 静 稳 定 的 状态 向 前 行走 。 


C 五 A a E' 4 C .五 A G@ 4 
| 2 \ a 
全 AR 
F B D r' 也 D!’ Fr 也 起 F B' DD 
a) d) 
图 2-9 六 足 步行 机 构 的 静 稳 定 步 行 图 


如 果 各 只 脚 有 2 个 自由 度 ， 就 可 以 在 凸凹 不 平 的 地 面 上 行走 。 为 了 能 够 转变 方向 ， 各 脚 
需 有 3 个 自由 度 就 足够 了 ， 如 图 2- 10 所 示 的 18 个 自由 度 的 六 足 步行 机 器 人 。 该 机 器 人 可 能 
有 相当 从 容 的 步 态 ， 但 总 共 要 有 18 个 自由 度 ， 包 含 力 传感器 
和 接触 传感器 和 倾斜 传感器 等 在 内 的 稳定 的 步行 控制 也 是 相 
当 复 杂 的 。 

综 上 所 述 可 知 ， 机 器 人 行走 机 构 按 移动 功能 来 分 有 和 车轮 
式 、 履 带 式 和 步行 式 三 种 。 这 三 种 移动 方式 的 原理 、 优 缺点 
比较 见 表 2-2。 从 运动 的 灵活 性 和 快速 性 来 考虑 ， 可 优先 选 
用 车 轮 式 的 移动 方式 ;从 越 障 和 带 载 能 力 来 考虑 ， 可 优先 选 ”图 ?10 18 个 自由 度 的 六 足 
用 步行 式 的 移动 方式 ; 从 负重 能 力 和 对 地 面 的 适应 性 方面 来 步行 机 器 人 
看 ， 可 优先 选用 履带 式 的 移动 方式 。 

表 2-2 机 器 人 移动 方式 的 比较 




































































移动 方式 原 带 优 到 忌 下 

不 轮 式 ”| ”配置 多 不 轮子 ,市 电 动机 独立 县 动 | 移动 速度 快 , 转 杰 容易 着 地面 积 丰 

履带 元 电动 机 驱动 两 个 无 轨道 履带 “| ”着地 面积 大 ,对 地 面 的 适应 性 强 | 体积 校 大 ,不易 详 现 转 杰 
力 9 各 4 > 

BR | 个 脚 或 框架 的 反复 着 地 进 | 可 越 障 , 带 载 能 力 较 强 移动 较 困难 ,行走 速度 慢 











2.2 机 需 人 未 端 操作 器 


机 器 人 的 手 ， 一 般 称 之 为 末端 操作 器 (也 称 为 夹 持 嚣 )。 它 是 机 器 人 直接 用 于 抓 取 
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和 握 紧 (吸附 ) 专用 工具 〈 如 喷枪 、 扳 手 、 焊 炬 和 喷头 等 ) ， 并 进行 操作 的 部 件 。 它 有 具 
有 模仿 人 手动 作 的 功能 ， 并 安装 于 机 器 人 手臂 的 前 端 。 由 于 被 握 工 件 的 形状 、 斥 才 、 
重量 、 材 质 及 表面 状态 等 不 同 , 因 此 机 带 人 末端 操作 器 是 多 种 多 样 的 ， 并 大 致 可 分 为 以 
下 几 类 : 中 夹 钳 式 取 料 手 ; 外 吸附 式 取 料 手 ; 加 专用 操作 器 及 转换 器 ; 由 仿生 多 指 灵 
巧 手 ; 名 其 他 手 。 


2.2.1 夹 钳 式 取 料 手 


夹 钳 式 手 部 与 人 手相 似 ， 是 机 器 人 广 为 应 用 的 一 种 手 部 形式 。 按 夹 取 的 方式 不 同 ， 可 分 
为 内 撑 式 和 外 夹 式 两 种 ， 分 别 如 图 2-11a、b 所 示 。 两 者 的 区 别 在 于 夹 持 工 件 的 部 位 不 同 ， 
手 爪 动作 的 方向 相反 。 








图 2-11 夹 钳 式 手 爪 的 夹 取 方 式 
a) 内 撑 式 b) 外 夹 式 


夹 钳 式 手 部 一 般 由 手指 ( 手 爪 ) 和 驱动 机 构 、 传 动机 构 及 连接 与 支承 元 件 组 成 ， 如 图 
2-12 所 示 ， 并 能 通过 手 爪 的 开 闭 动作 实现 对 物体 的 夹 持 。 

1. 手指 

手指 是 直接 与 工件 接触 的 构件 。 手 部 松 
开 和 夹 紧 工件 ， 就 是 通过 手指 的 张 开 和 闭合 
来 实现 的 。 机 器 人 的 手 部 一 般 只 有 两 个 手 
指 ， 少 数 有 三 个 或 多 个 。 手 指 的 结构 形式 常 
取决 于 工件 的 形状 和 特性 。 

指 端 的 形状 通常 有 两 类 : V 形 指 和 平面 
指 。V 形 指 由 于 定 心 性 好 ， 用 于 夹 持 圆柱 形 
工件 。 平 面 指 -一般 用 于 来 持 方形 工件 (具有 RE 
两 个 平行 平面 )、 板 形 或 细小 棒 料 。 为 外 ， | 手指 2 传动 机 构 3 一 驱动 机 构 4 支架 5 工件 
尖 指 和 注 、 长 指 一 般 用 于 夹 持 小 型 或 柔性 工 
件 。 其 中 ， 薄 指 一 般 用 于 夹 持 位 于 狭窄 工作 场地 的 细小 工件 ， 以 避免 和 周围 障碍 物 相 磁 ， 长 
指 一 般 用 于 夹 持 炽热 的 工件 ， 以 免 热 辐射 对 手 部 传动 机 构 的 影响 。 

指 面 的 形状 常 有 光滑 指 面 、 齿 形 指 面 和 柔性 指 面 等 。 光 滑 指 面 平整 光滑 ， 用 来 夹 持 已 加 
工 表 面 ， 可 屠 免 已 加 工 表面 受 损 。 齿 形 指 面 的 指 面 刻 有 齿 纹 ， 可 增加 夹 持 工 件 的 摩擦 力 ， 以 
确保 夹 紧 牢 靠 ， 多 用 于 夹 持 表面 粗糙 的 毛坯 或 半成品 。 柔 性 指 面 内 镰 橡 胶 、 泡 沫 、 石 槐 等 
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物 ， 有 增加 摩擦 力 、 保 护 工件 表面 、 隔 热 等 作用 ， 一 般 用 于 夹 持 已 加 工 表 面 、 炽 热 件 ， 也 适 
于 夹 持 薄 壁 件 和 脆性 工件 。 

2. 手指 传动 机 构 

传动 机 构 是 向 手指 传递 运动 和 动力 ， 从 而 实现 夹 紧 和 松 开 动作 的 机 构 。 该 机 构 根 据 手指 
开 合 的 动作 特点 分 为 回转 型 和 平移 型 两 种 。 其 中 回转 型 又 分 为 一 支点 回转 和 多 文 点 回转 ; 根 
据 手 爪 夹 紧 是 摆动 还 是 平 动 ， 回 转型 又 可 分 为 摆动 回转 型 和 平 动 回转 型 。 

(1) 回转 型 传动 机 构 “ 夹 钳 式 手 部 中 使 用 较 多 的 是 回转 型 手 部 ， 其 手指 就 是 一 对 杠杆 ， 
一 般 同 斜 棉 、 滑 模 、 连 杆 、 齿 轮 、 蜗 轮 蜗杆 或 螺杆 等 机 构 组 成 复合 式 杠 杆 传动 机 构 ， 用 以 改 
变 传动 比 和 运动 方向 等 。 

图 2- 13a 所 示 为 单 作用 和 斜 横 式 回 转型 手 部 结构 简 图 。 和 斜 横向 下 运动 ， 克 服 弹 算 拉 力 ， 使 
杠杆 手指 装着 滚 子 的 一 端 向 外 撑 开 ， 从 而 夹 紧 工 件 ;， 斜 攀 向 上 移动 ， 则 在 弹簧 拉力 作用 下 使 
手指 松 开 。 手 指 与 斜 杭 通 过 深 子 接触 可 以 减少 摩擦 力 ， 提 高 机 械 效率 。 有 时 为 了 简化 ， 也 可 
让 手指 与 斜 棉 直接 接触 ， 如 图 2- 13b 所 示 。 


















































图 2-13 和 斜 棉 杠 杆 式 回转 型 手 部 结构 简 图 
1 一 壳 体 2 一 和 斜 棉 驱 动 杆 ”3 一 深 子 4 一 圆柱 销 ”5 一 拉 答 6 一 贸 销 7 一 手指 8 一 工件 


























图 2-14 所 示 为 滑 模式 杠杆 回转 型 手 部 简 图 。 杠 
杆 形 手指 4 的 一 端 装 有 V 形 块 5, 另 一 端 则 开 有 长 滑 
槽 。 驱 动 杆 1 上 的 圆柱 销 2 在 滑 档 内 ， 当 驱动 连 杆 同 
圆柱 销 一 起 做 往复 运动 时 ， 即 可 拨 动 两 个 手指 各 绕 其 
支点 〈 铵 销 3) 做 相对 回转 运动 ， 从 而 实现 手指 的 夹 
紧 与 松 开动 作 。 

图 2-15 所 示 为 连 杆 式 杠杆 回转 型 手 部 简 图 。 驱 动 杆 
2 未 端 与 连 杆 4 由 铵 销 3 铵 接 ， 当 驱动 杆 2 做 直线 往复 
运动 时 ， 则 通过 连 杆 推 动 两 手指 各 绕 其 支点 做 回转 运动 ， 
从 而 使 手指 松 开 或 闭合 。 

图 2-16 所 示 为 齿轮 齿 条 直接 传动 的 齿轮 杠杆 式 图 2-14 滑 模式 杠杆 回转 型 手 部 简 图 
手 部 的 结构 简 图 。 了 驱动 杆 2 末端 制 成 双 面 具 条 ， 与 肩 。” ”1 一 驱动 村 2 一 圆柱 销 3 一 饺 销 
形 齿 轮 4 相 唉 合 ， 而 扇形 齿轮 4 与 手指 5 固 连 在 一 杠杆 形 手指 5 一 V 形 块 6 一 圆 形 工作 
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起 ， 可 绕 支 点 回转 。 驱 动力 推动 齿 条 做 直线 往复 运动 ， 带 动 鹿 形 齿轮 回转 ， 从 而 使 手 
指 松 开 或 闭合 。 






































图 2-15 连 杆 式 杠杆 回转 型 手 部 简 图 图 2-16 齿轮 杠杆 式 手 部 的 结构 简 图 
1 一 壳 体 2 一 驱动 杆 3 一 贸 销 4 一 连 杆 1 一 壳 体 2 一 驱动 杆 3 一 圆柱 销 
5 7 一 圆柱 销 6 一 手指 8 一 V 形 块 9 一 工件 4 一 扇形 齿轮 5 一 手指 6-V 形 块 7 一 工件 

















(2) 平移 型 传动 机 构 ”平移 型 夹 钳 式 手 部 是 通过 手指 的 指 面 做 直线 往复 运动 ， 或 平面 
移动 来 实现 张 开 或 闭合 动作 的 ， 常 用 于 夹 持 具有 平行 平面 的 工件 (如 钢板 等 )。 其 结构 较 复 
杂 ， 不 如 回转 型 手 部 应 用 广泛 。 

1) 直线 往复 移动 机 构 。 实 现 直 线 往 复 移 动 的 机 构 很 多 ， 常 用 的 有 和 斜 攀 传 动 、 齿 条 传动 
和 螺旋 传动 等 ， 均 可 应 用 于 手 部 结构 。 在 图 2-17 中 ， 图 2- 17a 为 斜 杭 平 移 机 构 ， 图 2-17b 
为 连 杆 杠杆 平移 结构 ， 图 2- 17c 为 螺旋 斜 攀 平 移 结构 。 它 们 既 可 是 双 指 型 的 ， 也 可 是 三 指 
(或 多 指 ) 型 的 ; 既 可 自动 定 心 ， 也 可 非 自 动 定 心 。 
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a) b) 9) 


图 2-17 直线 半 移 型 手 部 结构 简 图 
a) 斜 株 平移 结构 b) 连 杆 杠杆 平移 结构 c) 螺旋 斜 枫 平移 结构 














2) 平面 平行 移动 机 构 。 图 2- 18 所 示 为 几 种 平面 平行 平移 型 夹 钳 式 手 部 结构 简 图 。 它们 
的 共同 点 是 : 都 采用 平行 四 边 形 的 贸 链 机 构 一 一 双 曲 柄 匀 链 四 连 杆 机 构 ， 以 实现 手指 平移 。 
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其 差别 在 于 分 别 采用 齿 条 齿轮 、 蜗 杆 蜗 轮 和 连 杆 斜 滑 槽 的 传动 方式 。 








图 2-18 四 连 杆 机 构 平移 型 夹 钳 式 手 部 结构 简 图 
a) 齿 条 人 齿轮 传动 的 手 部 结构 b) 蜗杆 蜗轮 传动 的 手 部 结构 
<) 连 杆 斜 请 模 传 动 的 手 部 结构 
1 一 驱动 器 “2 一 驱动 元 件 3 一 驱动 摇 杆 4 一 从 动摇 村 5 一 手指 








3. 手指 驱动 机 构 

它 是 向 传动 机 构 提 供 动 力 的 装置 。 按 驱动 方式 的 不 同 ， 可 有 液压 、 气 动 和 电动 等 几 种 。 
按 实 现 的 运动 方式 不 同 ， 可 分 为 直线 驱动 机 构 和 旋转 驱动 机 构 两 种 。 

4. 手指 其 他 机 构 

来 钳 式 手 部 不 仅 有 上 面 所 述 的 手指 、 传 动机 构 和 驱动 机 构 ， 还 有 连接 和 支承 元 件 ， 将 上 
述 各 部 分 连接 成 一 个 整体 ， 并 实现 手 部 与 机 器 人 的 腕 部 的 连接 。 

夹 钳 式 手 部 的 设计 要 注意 下 面 七 个 问题 。 

1) 应 具有 足够 的 夹 紧 力 。 机 器 人 的 手 部 机 构 靠 钳 爪 夹 紧 工 件 ， 以 便 把 工件 从 一 个 位 置 
移动 到 另 一 个 位 置 。 由 于 工件 本 身 的 重量 ， 以 及 搬运 过 程 产 生 的 惯性 力 和 振动 等 ， 钳 爪 必须 
具有 足够 大 的 夹 紧 力 ， 才 能 防止 工件 在 移动 过 程 中 脱落 。 一 般 要 求 夹 紧 力 玉 为 工件 重量 G 
的 2~3 倍 ， 即 























F=KG (2-1) 
式 中 一 一 夹 紧 力 (N) ; 
天 一 一 安全 系数 ，K=2~3; 
6 一 一 工件 重量 (N) 。 

2) 应 具有 足够 的 张 开 角 。 钳 爪 为 了 抓 取 和 松 开工 件 ， 必 须 具 有 足够 大 的 张 开 角 度 来 适 
应 不 同 尺 寸 大 小 的 工件 ， 而 且 夹 持 工 件 的 中 心 位 置 变化 要 小 〈 即 定位 误差 要 小 ) 。 对 于 移动 
式 的 钳 爪 要 有 足够 大 的 移动 范围 。 

3) 应 能 保证 工件 的 可 靠 定位 。 为 了 使 钳 扑 和 被 夹 持 的 工件 保持 准确 的 相对 位 置 ， 必 须 
根据 被 抓 取 工件 的 形状 ， 选取 相应 的 手指 形状 来 定位 ， 如 圆柱 形 工件 多 数 采 用 具有 “V” 形 
钳 口 的 手指 ， 以 便 自动 定 心 。 

4) 应 具有 足够 的 强度 和 刚度 。 钳 爪 除 受 到 被 夹 持 工件 的 反作用 力 外 ， 还 受到 机 器 人 和 手 
部 在 运动 过 程 中 产生 的 惯性 力 和 振动 的 影响 。 如 果 没 有 足够 的 强度 和 刚度 ， 钳 爪 会 发 生 折 断 
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或 弯曲 变形 ， 因 此 对 于 受 力 较 大 的 钳 爪 应 进行 必要 的 强度 、 刚 度 的 校 核 计算 。 

5) 应 适应 被 抓 取 对 象 的 要 求 。(D 适 应 工件 的 形状 ， 工件 为 圆柱 形 ， 则 采用 带 “V” 形 
钳 口 的 手 爪 ; 工件 为 圆 球 形状 ， 则 选用 圆 弧 形 二 指 或 三 指 手 爪 ;对 于 特殊 形状 的 工件 应 设计 
与 工件 相 适 应 的 手 爪 。@ 适 应 被 抓 取 部 位 的 尺寸 工件 被 抓 取 部 位 的 尺寸 尽 可 能 是 不 变 的 ， 
知 加 工 太 十 略 有 变化 ， 那 么 钳 爪 应 能 适应 尺 二 变化 的 要 求 。 工 件 表面 质量 要 求 高 的 ， 对 钳 爪 
应 采取 相应 的 措施 ， 如 加 软 垫 等 。@ 要 适应 工作 位 置 状况 : 如 工作 位 置 较 宗 小 时 可 用 薄片 形 
状 的 手 爪 。 

6) 应 尽量 做 到 结构 紧凑 、 重 量 轻 和 效率 高 。 手 部 处 于 腕 部 和 辟 部 的 最 前 端 ， 运 动 状态 
变化 显著 。 其 结构 和 重量 ， 以 及 惯性 负荷 将 直接 影响 到 腕 部 和 辟 部 的 结构 ， 因 此 ， 在 手 部 设 
计时 ， 必 须 力 求 结 构 紧 凑 、 重 量 轻 和 效率 高 。 

7) 应 具有 一 定 的 通用 性 和 互 换 性 。 一 般 情况 下 的 手 部 都 是 专用 的 ， 为 了 扩大 它 的 使 用 
范围 ， 提 高 通用 化 程度 ， 以 适应 夹 持 不 同 尺 寸 和 形状 的 工件 的 需要 ， 常 采用 可 调整 的 方法 ， 
如 更 换 手指 ， 甚 至 更 换 整 个 手 部 。 也 可 为 手 部 设计 专门 的 过 渡 接 头 ， 以 便 迅 速 准确 地 更 换 
工具 


“An 


2.2.2 吸附 式 取 料 手 


根据 吸附 力 的 种 类 不 同 ， 吸 附 式 取 料 手 可 以 分 为 磁 吸 式 和 和 气 吸 式 两 种 。 

1. 磁 吸 式 手 部 

(1) 工作 原理 ” 磁 吸 式 手 部 是 利用 永久 磁铁 或 电磁 铁通 电 后 产生 磁力 来 吸取 铁 磁性 材 
料 工 件 的 装置 。 采 用 电磁 吸盘 的 磁 吸 式 手 部 结构 如 网 2- 19 所 示 。 当 线圈 通电 瞬时 ， 由 于 空 
气 隐 的 存在 , 磁 阻 很 大 ， 线 圈 的 电感 和 起 动 电流 很 大 ， 这 时 产生 磁性 吸力 可 将 工件 吸 住 ， 一 
且 断 电 后 ， 磁 吸力 消失 ， 即 将 工件 松 开 。 若 采用 永久 磁铁 作为 吸盘 ， 则 需要 强迫 将 工件 
取 下 。 





















































































































































a) b) 


图 2-19 电磁 吸盘 的 结构 示意 网 
a) 电磁 铁 工作 原理 b) 盘 状 电磁 铁 
1 一 线圈 “2 一 铁心 “3 一 衔 铁 








(2) 磁 吸 式 手 部 的 设计 要 点 

1) 应 具有 足够 的 吸力 。 电 磁 吸 引力 应 根据 工件 的 重量 而 定 。 电 磁 吸 盘 的 形状 、 尺 寸 以 
及 线圈 一 旦 确定 ， 其 吸力 的 大 小 也 就 基本 上 确定 ， 吸 力 的 大 小 可 通过 改变 施加 电压 进行 
微调 。 
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2) 应 根据 被 吸附 工件 的 形状 、 大 小 来 确定 电磁 吸盘 的 形状 、 大 小 ， 吸 盘 的 吸附 面 应 与 
工件 的 被 吸附 表面 形状 一 致 。 
(3) 电磁 吸力 的 计算 
1) 直流 电磁 铁 的 吸力 计算 。 以 “TT” 形 电磁 铁 为 例 ， 如 图 2-19 所 示 。 当 通 人 直流 电 
时 ,根据 麦 克 斯 韦 理 论 ， 电 磁 吸 力 为 
二 
ras] S (2-2) 


500 














式 中 一 一 电磁 吸力 (N) ; 
Bo 一 一 空气 隙 中 的 磁感应 强度 (T)，; 
5 一 一 气 隙 的 横 截 面积 ， 也 就 是 铁心 的 横 截 面积 (cm?)。 
2) 交流 电磁 铁 的 吸力 计算 。 对 于 交流 电磁 铁 ， 由 于 通电 后 磁 路 中 的 磁 通 量 是 波动 的 ， 


所 以 吸力 是 波动 的 ， 其 平均 吸力 为 
B 有 
pn- S (2-3) 


B, 一 一 空气 隙 中 波动 的 磁感应 强度 的 最 大 值 (T) ; 
4S 一 一 铁心 横 截 面积 (ecm? ) 。 

2. 气 吸 式 手 部 

(1) 工作 原理 气 吸 式 手 部 是 利用 橡胶 皮 碗 或 软 塑 料 碗 中 所 形成 的 负 压 把 工件 吸 
住 的 装置 。 适 用 于 薄 铁 片 、 板 材 、 纸 张 、 薄 而 易 脆 的 玻璃 器 下 和 弧 形 壳 体 零件 等 的 抓 
取 。 按 形成 负 压 的 方法 ， 可 以 将 气 吸 式 手 部 分 为 : 真空 式 、 气 流 负 压 式 和 挤 气 负 压 式 
三 种 吸盘 。 

1) 真空 式 吸盘 。 这 种 吸盘 吸附 可 靠 、 吸 力 大 、 结 构 简 单 ， 但 是 需要 有 真空 控制 系 
统 ， 故 成 本 较 高 。 图 2-20 所 示 为 真空 吸附 取 料 手 结 构图 。 其 真空 的 产生 是 利用 真空 
泵 ， 真 空 度 较 高 。 主 要 零件 为 碟 形 橡胶 吸盘 1， 通 过 固定 环 2 安装 在 支承 杆 4 上， 支承 
杆 由 螺母 6 固定 在 基板 上 。 取 料 时 ， 碟 形 橡胶 吸盘 与 物体 表面 接触 ， 橡 胶 吸 盘 的 边缘 
既 起 到 密封 作用 ， 又 起 到 缓冲 作用 ， 然 后 真空 抽 气 ， 
吸盘 内 腔 形成 真空 ， 吸 取 物 料 ; 放 料 时 ， 管 路 接 通 大 
气 ， 失 去 真空 ， 物 体 放下 。 为 避免 在 取 、 放 料 时 产生 
撞击 ， 有 的 还 在 支承 杆 上 配 有 弹簧 缓冲 。 

2) 气流 负 压 式 吸盘 。 工 业 现场 有 压缩 空气 站 时 ， 采 
用 气流 负 压 式 吸 盘 比 较 方便 ， 并 且 成 本 低 ， 因 此 应 用 较 
广 。 图 2-21 所 示 为 气流 负 压 吸附 取 料 手 结构 图 。 气 流 负 
压 吸 附 取 料 手 是 利用 流体 力学 的 原理 ， 当 需要 取 物 时 ， 
压缩 空气 高 速 流 经 喷嘴 5 时 ， 其 出 口 处 的 气压 低 于 吸盘 
腔 内 的 气压 ， 于 是 腔 内 的 气体 被 高 速 气流 带 走 形成 负 压 ， 图 2.20 真空 吸附 取 料 手 结构 图 
完成 取 物 动作 ; 当 需 要 释放 时 ， 切断 压 缩 空 气 即 可 。 图 。 1 一 橡胶 吸盘 2 一 固定 环 。 3 一 热 片 
2-22 所 示 为 气流 负 压 吸附 取 料 机 器 人 。 4 一 支承 村 5 一 基板 6 一 螺母 
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图 2-21 气流 负 压 吸附 取 料 手 结构 图 图 2-22 气流 负 压 吸附 取 料 机 器 人 
1 一 橡胶 吸盘 ”2 一 心 套 3 一 透气 螺钉 
4 一 支承 杆 5 一 喷嘴 ”6 一 喷嘴 套 








如 图 2-23 所 示 ， 当 气 源 工作 ， 电 磁 闪 2 的 左 位 工作 时 ， 压 缩 空气 从 真空 发 生 右 3 左 侧 
进入 ， 并 产生 主 射流 ， 主 射流 卷 吸 周围 静止 的 气体 一 起 向 前 流动 ， 从 真空 发 生 器 3 的 右 口 流 
出 。 于 是 在 射流 的 周围 形成 了 一 个 低压 区 ， 接 收 气 爪 6 室内 的 气体 被 吸 进来 与 其 相 融 合 在 一 
起 流出 ， 在 接收 室内 及 吸 头 处 形成 负 压 ， 当 负 压 达到 一 定 值 时 ， 可 将 工件 吸 起 来 ， 此 时 压力 
开关 5 可 发 出 一 个 工件 已 被 吸 起 的 信和 号。 

3) 挤 气 负 压 式 吸盘 。 该 吸盘 不 需要 配备 复杂 的 进 、 排 气 系统 ， 因 此 系统 构成 较 简单 ， 
成 本 也 较 低 。 但 由 于 吸力 不 大 ， 仅 适用 于 吸附 轻 小 的 片 状 工件 。 

图 2- 24 所 示 为 挤 压 式 取 料 手 结构 图 。 其 工作 原理 为 : 取 料 时 吸盘 压 紧 物体 ， 橡 胶 吸 盘 
1 变形 ， 挤 出 腔 内 多 余 的 空气 ， 取 料 手 上 升 ， 靠 橡胶 吸盘 的 恢复 力 形成 负 压 ， 将 物体 吸 住 ; 
释放 时 ， 压 下 拉杆 3， 使 吸盘 腔 与 大 气相 连通 而 失去 负 压 。 该 取 料 手 结构 简单 , 但 吸附 力 小 ， 
吸附 状态 不 易 长 期 保持 。 
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图 2-23 气流 负 压 吸附 取 料 手气 路 原理 图 图 2-24 挤 压 式 取 料 手 结构 图 
1 一 气 源 “2 一 电磁 阀 ”3 一 真空 发 生 器 1 一 吸盘 2 一 弹簧 3 一 拉杆 




















4 一 消声器 ”5 一 压力 开关 6 一 气 扑 
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(2) 气 吸 式 手 部 的 设计 要 点 

1) 吸力 大 小 与 吸盘 的 直径 大 小 、 吸 盘 内 的 真空 度 (或 负 压 大 小 )， 以 及 吸盘 的 吸附 面 
积 的 大 小 有 关 。 工 件 被 吸附 表面 的 形状 和 表面 不 平 度 也 对 其 有 一 定 的 影响 ,设计 时 要 充分 考 
虑 上 述 各 种 因素 ， 以 保证 有 足够 的 吸附 力 。 

2) 应 根据 被 抓 取 工件 的 要 求 确定 吸盘 的 形状 。 由 于 气 吸 式 手 部 多 吸附 薄片 状 的 工件 ， 
故 可 用 耐 油 橡 胺 压制 成 不 同 尺寸 的 盘 状 吸 头 。 

(3) 气 吸 式 手 部 的 吸力 计算 ”吸盘 吸力 的 大 小 主要 取决 于 真空 度 (或 负 压 的 大 小 ) 与 
吸附 面积 的 大 小 。 气 流 负 压 式 的 气流 压力 与 流量 、 挤 压 式 吸盘 内 腔 的 大 小 等 对 吸盘 均 有 影 
响 。 在 计算 吸盘 吸力 时 ， 应 根据 实际 的 工作 状态 ， 对 计算 吸力 进行 必要 的 修正 。 

对 于 真空 吸盘 来 说 ， 其 吸力 下 可 近似 计算 为 


7D2T 万 
Rs 一 (2-4) 
4K|K,K3\76 











式 中 一 一 盘 吸 力 (N); 

真空 度 (mmHg); 

吸盘 数量 ; 

DD 一 一 吸盘 直径 (cm); 

Ki 一 一 安全 系数 ,一 般 取 1.2~2; 

已 一 一 工 况 系数 ， 一 般 可 取 1. 1~2. 5; 

有 太一 一 方位 系数 。 吸 附 水 平 放置 的 工件 时 ， 可 取 Ks=1; 吸附 垂直 放置 的 工件 时 ，Ks 
=1A (1 为 摩擦 因数 )， 吸盘 材料 为 橡胶 ,工件 材料 为 金属 时 ,可取 j= 
0.5~0.8。 


2. 2.3 专用 操作 器 及 转换 器 


1. 专用 末端 操作 器 

机 器 人 是 一 种 通用 性 很 强 的 自动 化 设备 ， 可 根据 作业 要 求 完 成 各 种 动作 ， 再 配 上 各 种 专 
用 的 末端 操作 器 后 ， 就 能 完成 各 种 动作 。 如 在 通用 机 器 人 上 安装 焊 枪 就 成 为 一 台 焊 接 机 器 
人 ， 安 装 拧 螺 母 机 则 成 为 一 台 装 配 机 器 人 。 

目前 有 许多 由 专用 电动 、 气 动工 具 改 型 而 成 的 操作 器 ， 如 图 2-25 所 示 ， 有 拧 螺 母 机 、 
焊 枪 、 电 磨 头 、 电 铣 头 、 抛 光头 和 激光 切割 机 等 ， 所 形成 的 一 整套 系列 供用 户 选用 ， 使 机 器 
人 能 胜任 各 种 工作 。 图 2-25 还 有 一 个 装 有 电磁 吸盘 式 换 接 器 的 机 器 人 手腕 ， 电 磁 吸 盘 直 入 
为 60mm， 质 量 为 1kg ， 吸 力 为 1100N， 换 接 器 可 接 通 电源 、 信 号、 压力 气 源 和 真空 源 ， 电 
插头 有 18 芯 ， 气 路 接头 有 5 路 。 为 了 保证 连接 位 置 精 度 ， 设 置 了 两 个 定位 销 。 在 各 未 端 操 
作 器 的 端面 装 有 换 接 咒 座 ， 平 时 放置 于 工具 架 上 ， 需 要 使 用 时 机 器 人 手腕 上 的 换 接 器 吸盘 可 
从 正面 吸 牢 换 接 器 座 ， 接 通电 源 和 气 源 ， 然 后 从 侧面 将 末端 操作 器 退出 工具 架 ， 机 器 人 便 可 
进行 作业 。 

2. 换 接 器 

对 于 通用 机 器 人 来 说 ， 要 在 作业 时 能 自动 更 换 不 同 的 末端 操作 器 ， 就 需要 配置 具有 快速 
装 印 功能 的 换 接 器 。 换 接 器 通常 由 两 部 分 组 成 : 换 接 器 插座 和 换 接 器 插头 ， 分 别 装 在 机 器 人 
腕 部 和 末端 操作 器 上 ， 能 够 实现 机 器 人 对 末端 操作 器 的 快速 自动 更 换 。 








n 
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图 2-25 各 种 专用 末端 操作 器 和 电磁 吸盘 式 换 接 器 





1 一 气 路 接口 “2 一 定位 销 ”3 一 电 接头 “4 一 电磁 吸盘 


对 换 接 器 的 要 求 主 要 有 : 同时 具备 气 源 、 电 源 及 信号 的 快速 连接 与 切换 ; 能 承受 未 端 操 
作 顺 的 工作 载荷 ; 在 失 电 、 失 气 情况 下 ， 机 咒 人 停止 工作 时 不 会 自行 脱离 ; 具有 一 定 的 换 接 


精度 等 。 

图 2-26 所 示 为 气动 换 接 絮 与 专用 末端 操作 器 
库 。 该 换 接 絮 也 分 成 两 部 分 : 一 部 分 装 在 手腕 上 ， 
称 为 换 接 器 ， 男 一 部 分 装 在 末端 操作 右上 ， 称 为 配 
合 右 。 利 用 气动 锁 紧 带 将 两 部 分 进行 连接 ， 并 具有 
就 位 指示 信号 以 表示 电路 、 气 路 是 否 接 通 。 

3. 多 工 位 换 接 装置 

某 些 机 器 人 的 作业 任务 相对 较为 集中 ， 需 要 换 
接 一 定量 的 末端 操作 器 ， 又 不 必 配 备 数量 较 多 的 末 
端 操作 融 库 。 这 样 可 以 在 机 絮 人 手腕 上 设置 一 个 多 
工 位 换 接 装 置 。 例 如 ， 在 机 器 人 和 柔性 装配 线 某 个 工 
位 上 ， 机 器 人 要 依次 装配 如 垫圈 、 螺 钉 等 几 种 零 
件 ， 装 配 采 用 多 工 位 换 接 装置 ， 可 以 从 几 个 供 料 处 
依次 抓 取 几 种 零件 ， 然 后 逐个 进行 装配 ， 既 可 以 节 
省 几 台 专用 机 器 人 ， 又 可 以 避免 通用 机 器 人 频繁 换 
接 操 作 器 和 方 省 装配 作业 时 间 。 

多 工 位 换 接 装 置 示意 图 如 图 2-27 所 示 ， 就 像 数 
控 加 工 中 心 的 刀 库 一 样 ， 有 楼 锥 型 和 棱柱 型 两 种 形 
式 。 棱 锥 型 换 接 装置 可 保证 手 爪 轴线 和 手腕 轴线 一 
致 ， 受 力 较 合理 ,但 其 传动 机 构 较 为 复杂 ; 楼 柱 型 换 
接 带 传动 机 构 较 为 简单 ， 但 其 手 爪 轴线 和 手腕 轴线 不 























图 2-26 气动 换 接 器 与 专用 末端 操作 器 库 
1 一 末端 操作 器 库 2、6 一 过 渡 法 兰 
3 一 位 置 指示 灯 4 一 气 路 ”5 一 连接 法 兰 
7 一 换 接 器 ”8 一 换 拉 接 器 配合 端 
9 一 末端 操作 器 
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能 保持 一 致 ， 受 力 不 均 。 


























b) 





图 2-27 多 工 位 换 接 装置 示意 图 
a) 棱锥 型 b) 棱柱 型 














2.2.4 仿生 多 指 灵 巧 手 


来 钳 式 取 料 手 不 能 适应 物体 外 形变 化 ,不 能 使 物体 表面 承受 比较 均匀 的 夹 持 力 , 因此 无 
法 对 复杂 形状 、 不 同 材质 的 物体 实施 夹 持 和 操作 。 为 了 提高 机 器 人 手 扑 和 手腕 的 操作 能 力 、 
灵活 性 和 快速 反应 能 力 ， 使 机 器 人 能 像 人 手 那 样 进行 各 种 复杂 的 作业 ， 如 装配 作业 、 维 修 作 
业 和 设备 操作 等 ， 就 必须 有 一 个 运动 灵活 、 动 作 多 样 的 灵巧 手 。 

1. 柔性 手 

为 了 能 对 不 同 外 形 的 物体 实施 抓 取 ， 并 使 物体 表面 受 力 比较 均匀 ， 因 此 研制 出 了 柔性 手 。 
图 2-28 所 示 为 多 关节 柔性 手 ， 每 个 手指 由 多 个 关节 串联 而 成 。 手 指 传 动 部 分 由 牵引 钢丝 绳 及 
谭 擦 滚轮 组 成 ， 每 个 手指 由 两 根 钢丝 绳 牵引 ， 一 侧 为 握 紧 ， 男 一 侧 为 放松 。 了 驱动 源 可 采用 电动 
机 驱动 或 液压 、 气 动 元 件 驱 动 。 柔 性 手 可 抓 取 四 凸 不 平 的 物体 ， 并 使 物体 受 力 较为 均匀 。 






































图 2-28 多 关节 柔性 手 





如 图 2-29 所 示 为 用 柔性 材料 做 成 的 柔性 手 ， 由 工件 1、 手指 2、 电 磁 闪 3 和 液压 币 4 等 
构成 。 该 手 一 端 固定 ， 另 一 端 为 自由 端的 双 管 合 一 的 柔性 管状 手 扑 ， 当 一 侧 管内 充 液 、 另 一 
侧 管内 抽 液 时 形成 压力 差 ， 柔 性 手 爪 就 向 抽空 侧 弯曲 。 此 种 柔性 手 适 用 于 抓 取 轻型 、 圆 形 物 
体 ， 如 玻璃 器 严 等 。 
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图 2-29 柔性 手 





1 一 工件 2 一 手指 3 一 电磁 阀 4 一 液压 饶 





2. 多 指 灵巧 手 

多 指 灵巧 手 是 指 具 有 3 个 及 其 以 上 数目 的 机 械 手 。 它 的 较 完美 的 形式 是 模仿 人 类 的 5 指 
手 。 多 指 灵 巧 手 作为 人 类 活动 肢体 的 有 效 延 伸 ， 能 够 完成 灵活 、 精 细 的 抓 取 操 作 。 从 20 世 
纪 后 半期 开始 ， 多 指 灵巧 手 作 为 机 器 人 领域 的 热门 研究 方向 之 一 ， 被 各 国 的 科技 人 员 所 研 
究 。 例 如 ， 日 本 Gifu 大 学 于 2002 年 研制 的 GifuII， 如 图 2-30 所 示 ， 有 5 个 手指 、16 个 自由 
度 。 每 个 手指 有 3 个 自由 度 ， 未 端的 两 个 关节 通过 连 杆 耦合 运动 ， 拇 指 另 有 一 个 相对 手掌 和 
其 余 4 指 开 合 的 自由 度 ， 类 似 人 手 的 拇指 。 采 用 集成 在 手 内 部 的 微型 直流 电动 机 驱动 , 具有 
间 尖 6 维 力 / 力 矩 、 触 觉 等 感知 功能 。 

HITADLR 手 (多 指 手 ) 是 哈尔滨 工业 大 学 (HIT) 和 德国 宇航 中 心 (DLR) 合作 开发 的 多 
指 多 感知 机 器 人 灵巧 手 ， 分 别 于 2004 年 和 2008 年 研制 成 功 了 HITADLRI 手 (图 2-31a) 和 
HITZDLRIH 手 (图 2-31b)。HITADLR I 手 由 4 个 相同 的 模块 化 手指 组 成 ， 每 个 手指 有 4 个 关 
节 、3 个 自由 度 ， 拇 指 另 有 一 个 相对 手掌 开 合 的 自由 度 ， 共 有 13 个 自由 度 ， 采 用 商业 化 的 直流 
无 刷 电动 机 驱动 ， 具 有 位 置 (电动 机 /关节 ) 、 关 节 力 矩 、 指 尖 6 维 力 / 力 和 矩 、 温 度 等 多 种 感知 
功能 ， 所 有 的 驱动 、 减 速 、 传 感 及 电气 等 都 集成 在 手掌 或 手指 内 ， 图 2-31 所 示 的 HITADLRI 多 
指 灵 巧 手 具 有 拟人 手 形 的 外 观 ， 基 于 多 层 FPGA 和 DSP 实现 了 灵巧 手 的 高 速 串 行 通信 和 实时 控 
制 ， 质量 为 1. 8kg， 体 积 大 约 是 人 手 的 1.5 倍 。HITZDLRI 手 由 5 个 相同 的 模块 化 手指 组 成 ， 共 
具有 15 个 自由 度 ,， 采用 体积 小 、 重 量 轻 的 盘 式 电动 机 驱动 和 谐 波 减速 器 及 同步 带 的 传动 方案 ， 
具有 CAN 、PPSECO (点 对 点 高 速 串 行 通信 ) 、Internet 等 多 种 通信 接口 ， 将 PCI-DSP 控制 卡 
集成 到 手掌 内 ， 利 用 更 高 容量 的 FPGA 芯片 和 NIOS 双核 处 理 器 ， 实 现 灵巧 手 的 实时 通信 和 多 
种 通信 接口 ， 质 量 为 1. 5kg, 体积 与 人 手相 当 ， 在 手指 数目 、 体 积 、 重 量 、 集 成 度 、 电 气 接口 
等 方面 ， 相 对 工 型 手 有 较 大 的 提高 ， 更 加 仿 人 手 化 。 








图 2-30 日 本 Gifu 大 学 研制 的 多 指 灵巧 手 图 2-31 ”哈工大 研制 的 多 指 灵巧 手 
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随 着 世界 科技 的 发 展 ， 机 需 人 多 指 灵 巧 手 正在 日 益 旨 着 具有 和 柔顺 灵巧 的 操作 功能 ， 具 有 
力 觉 、 触 党 、 视 觉 等 智能 化 方向 发 展 。 多 指 灵 巧 手 的 应 用 前 景 将 更 加 广泛 ， 不仅 可 在 核 工业 
领域 和 宇宙 空间 作业 ， 而 且 可 以 在 高 温 、 高 压 、 高 真空 等 各 种 极限 环境 下 完成 人 无 法 实现 的 
操作 。 























2.2.5 其 他 手 
1. 弹性 力 手 爪 








弹性 力 手 爪 的 特点 是 其 夹 持 物体 的 抓 力 是 由 弹性 元 件 提供 的 ， 不 需要 专门 的 驱动 装置 ， 
在 抓 取 物体 时 需要 一 定 的 压力 ， 而 在 御 料 时 ， 则 需要 一 定 的 拉力 。 

图 2-32 所 示 为 一 种 弹性 力 手 爪 的 结构 原理 图 ， 图 中 的 手 扑 有 一 
个 固定 爪 1 和男 一 个 活动 爪 6， 靠 压 自 4 提供 抓 力 ,活动 扑 绕 轴 5 回 
转 ， 空 手 时 其 回转 角度 由 接触 面 2、3 限制 。 抓 物 时 ， 活 动 不 6 在 推 
力作 用 下 张 开 ， 靠 下 上 的 四 槽 和 弹性 力 抓 取 物 体 ; 印 料 时 ， 需 固定 物 
体 的 侧面 ， 手 扑 用 力 拔 出 即 可 。 

2. 摆动 式 手 扑 

摆动 式 手 爪 的 特点 是 在 手 爪 的 开 合 过 程 中 ， 其 手 爪 的 运动 状态 是 
绕 固 定 轴 摆 动 的 ， 结 构 简 单 ， 使 用 较 广 ， 适 合 于 圆柱 表面 物体 的 抓 
取 。 图 2-33 所 示 为 一 种 摆动 式 手 爪 的 结构 原理 图 。 这 是 一 种 连 杆 扎 由， 剖 相 放手 不 
动 式 手 爪 ， 活塞 杆 移 动 ， 并 通过 连 杆 带动 手 爪 回 绕 同 一 轴 摆 动 ， 完成 1 一 固定 爪 “2 .3 一 接触 面 
开 合 动作 。 4 一 压 策 5 一 轴 6 一 活动 扑 
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图 2-33 ”摆动 式 手 扑 
1 一 手巾 ”2 一 夹 紧 液 压 氏 3 一 活塞 杆 4、12 一 锥 齿轮 5、11 一 键 ”6 一 行程 开关 
7 一 推力 轴承 热 ”8 一 活塞 套 9 一 主体 轴 10 一 圆柱 齿轮 ”13 一 升降 液压 氏 体 
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3. 钩 托 式 手 

图 2-34 所 示 为 钩 托 式 手 部 结构 示意 图 。 钩 托 式 手 部 不 是 靠 外 部 施加 的 夹 紧 力 来 夹 持 工 
件 ， 而 是 利用 工件 本 身 的 重量 ， 通 过 手指 对 工件 的 钩 、 托 、 捧 等 动作 来 托 持 工件 。 应 用 钩 托 
方式 可 降低 对 驱动 力 的 要 求 ， 简 化 手 部 结构 ， 甚 至 可 以 省 略 手 部 驱动 装置 。 该 手 部 适用 于 在 
水 平面 内 和 垂直 面 内 搬运 大 型 笨重 的 工件 或 结构 粗大 而 重量 较 轻 且 易 变形 的 物体 。 钩 托 式 手 
部 又 分 为 无 驱动 装置 的 手 部 和 有 了 驱动 装置 的 手 部 两 种 类 型 。 


















































图 2-34 钧 托 式 手 部 结构 示意 图 
a) 无 驱动 装置 的 手 部 b) 有 驱动 装置 的 手 部 
1 一 齿 条 ”2 一 齿轮 3 一 手指 4 一 销 子 5 一 驱动 液压 和 67 一 杠杆 手指 








2.3 ”机 费 人 手腕 


机 器 人 手腕 是 连接 末端 操作 器 和 手臂 的 部 件 。 它 的 作用 是 调节 或 改变 工件 的 方位 ， 因 而 
它 具 有 独立 的 自由 度 ， 以 使 机 器 人 末端 操作 器 适应 复杂 的 动作 要 求 。 

机 器 人 一 般 需 要 6 个 自由 度 才 能 使 手 部 达到 目标 位 置 并 处 于 期 望 的 姿态 。 为 了 使 手 部 能 
处 于 空间 任意 方向 ， 要 求 腕 部 能 实现 对 空间 3 个 坐标 轴 x、y、z 的 转动 ， 即 具有 翻转 、 俯 你 
和 偏转 3 个 自由 度 ， 如 图 2-35 所 示 。 通 常 也 把 手腕 的 翻转 称 为 Rol， 用 R 表示 ; 把 手腕 的 
俯仰 称 为 Piteh， 用 P 表示 ; 把 手腕 的 偏转 称 为 Yaw， 用 YY 表示。 


























图 2-35 手腕 自由 度 示意 图 
a) 绕 z 轴 转动 b) 绕 y 轴 转动 ec) 绕 *x 轴 转动 d) 绕 x、y、z 轴 转 动 
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2. 3. 1 手腕 的 分 类 


1. 按 自由 度数 目 来 分 

手腕 按 自 由 度数 目 来 分 ， 可 分 为 单 自 由 度 手腕 、 双 自由 度 手 腕 和 三 自由 度 手 腕 。 

(1) 单 自由 度 手腕 ” 单 自 由 度 手 腕 如 图 2-36 所 示 。 图 2-36a 是 一 种 翻转 ( Roll) 关节 ， 
它 把 手臂 纵 轴 线 和 手腕 关节 轴线 构成 共 轴 形式 。 这 种 R 关节 旋转 角度 大 ， 可 达到 360° 以 上 。 
图 2-36b、c 是 一 种 折 曲 (Bend) 关节 (简称 B 关节 )， 关 节 轴 线 与 前 后 两 个 连接 件 的 轴线 
相 垂直 。 这 种 B 关 节 因 为 受到 结构 上 的 干涉 ， 旋 转角 度 小 ， 大 大 限制 了 方向 角 。 图 2-36d 
所 示 为 移动 关节 。 


a) b) 





























图 2-36 单 自由 度 手腕 示意 图 
a) RR 手腕 b)、c) B 手 腕 d) T 手 腕 











(2) 双 自 由 度 手 腕 ” 双 自 由 度 手腕 如 图 2-37 所 示 。 双 自由 度 手 腕 可 以 由 一 个 B 关节 和 
一 个 R 关节 组 成 BR 手腕 ( 见 图 2-37a); 也 可 以 由 两 个 B 关节 组 成 BB 手腕 〈 见 图 2-37b) 。 
但 是 ,不 能 由 两 个 R 关节 组 成 RR 手 腻 ， 因 为 两 个 R 关节 共 轴 线 ， 所 以 退化 了 一 个 自由 度 ， 
实际 只 构成 了 单 自由 度 手 腕 ( 见 图 2-37c)。 


偏转 
et Db 人 
局 ae 如 人 COCDe - 
b) 


俯仰 俯仰 
a) 


图 2-37 双 自 由 度 手腕 示意 图 
a) BR 手腕 b) BB 手腕 c) RR 手 胸 





(3) 三 自由 度 手腕 ”三 自由 度 手腕 如 图 2-38 所 示 。 三 自由 度 手腕 可 以 由 B 关节 和 R 关 
节 组 成 多 种 形式 。 图 2-38a 所 示 是 通常 见 到 的 BBR 手 脏 ， 使 手 部 具有 俯仰 、 偏 转 和 翻转 运 
动 ， 即 RPY 运动 。 图 2-38b 所 示 是 由 一 个 B 关节 和 两 个 R 关节 组 成 的 BRR 手腕 ， 为 了 不 使 
自由 度 退 化 ， 使 手 部 产生 RPY 运动 ， 第 一 个 R 关节 必须 进行 如 图 2-38b 所 示 的 偏 置 。 图 
2-38c 所 示 是 由 3 个 R 关 节 组 成 的 RRR 手腕， 它 也 可 以 实现 手 部 RPY 运动 。 图 2-38d 所 示 
是 BBB 手 腊 ,很 明显 ， 它 已 退化 为 双 自 由 度 手 腕 ， 只 有 PY 运动 ， 实际 上 并 不 采用 这 种 手 
腕 。 此 外 ，B 关节 和 有 关节 排列 的 次 序 不 同 ， 也 会 产生 不 同 的 效果 ， 同 时 产生 了 其 他 形式 的 
三 自由 度 手腕 。 为 了 使 手腕 结构 紧凑 ， 通 常 把 两 个 B 关节 安装 在 一 个 十 字 接 头 上 ， 这 对 于 
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BBR 手腕 来 说 ， 大 大 减 小 了 手腕 纵向 尺寸 。 





zis 偏转 
区 ~ 加 \ 
人 俯仰 


\ 
俯仰 





d) 


图 2-38 三 自由 度 手 腕 示意 图 
a) BBR 手腕 b) BRR 手腕 c) RRR 手腕 d) BBB 手 胸 








2. 按 驱 动 位 置 来 分 

手腕 按 驱 动 位 置 来 分 ， 可 分 为 直接 驱动 手腕 和 间接 远 距 离 传 动手 腕 。 

图 2- 39 所 示 为 Moog 公司 的 一 种 液压 直接 驱动 BBR 手腕 ,设计 紧凑 巧妙 。M]j 、M,、M 
是 液压 马达 ， 直 接 驱 动手 腕 的 偏转 、 俯 仰 和 翻转 三 个 自由 度 。 

图 2-40 所 示 为 一 种 远 距 离 传动 的 RBR 手腕 。 耳 轴 的 转动 使 整个 手腕 翻转 ， 即 第 一 个 R 
关节 运动 ; 开 轴 的 转动 使 手腕 获得 俯仰 运动 ， 即 第 二 个 B 关节 运动 ;I 轴 的 转动 即 第 三 个 R 
关节 运动 。 当 < 轴 离 开 纸 平面 后 ，RBR 手腕 便 在 三 个 自由 度 轴 上 输出 RPY 运动 。 这 种 远 距 
离 传 动 的 好 处 是 可 以 把 尺寸 、 重 量 都 较 重 的 驱动 源 放 在 远离 手腕 处 ， 有 时 放 在 手臂 的 后 端 做 
平衡 重量 用 ， 这 样 不 仅 减轻 了 手腕 的 整体 重量 和 转动 惯量 ， 而 且 改 善 了 机 器 人 的 整体 结构 的 
平衡 性 。 
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图 2-39 直接 驱动 型 “BBR” 手 腕 示意 图 图 2-40 远 距 离 传 动 “RBR” 手 腕 示意 图 





2. 3. 2 腕 部 的 设计 要 点 
腕 部 设计 时 一 般 要 注意 下 列 几 个 要 点 : 
29 
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1) 结构 应 尽量 紧凑 、 重 量 轻 。 因 为 手腕 处 于 手臂 的 端 部 ， 并 连接 手 部 ， 所 以 ， 机 器 人 
手 避 在 携带 工具 或 抓 取 工 件 ， 并 进行 作业 或 搬运 过 程 中 ， 所 受 动 、 静 载 稍 ， 以 及 被 夹 持 物体 
及 手 部 、 腕 部 等 机 构 的 重量 ， 均 作用 在 手 辟 上。 显然 ， 它 们 直接 影响 着 辟 部 的 结构 尺寸 和 性 
能 ， 所 以 在 设计 手腕 时 ， 尽 可 能 使 结构 紧凑 及 重量 经 ， 不 要 盲目 追求 手腕 具有 较 多 的 自由 
度 。 对 于 自由 度数 目 较 多 以 及 驱动 力 要 求 较 大 的 腕 部 ， 结 构 设计 矛盾 较为 突出 ， 因 为 对 于 腕 
部 每 一 个 自由 度 就 要 相应 配 有 一 套 驱动 系统 。 要 使 腕 部 在 较 小 的 空间 内 同时 容纳 几 套 动力 元 
件 ， 困 难 较 大 。 从 现 有 的 结构 来 看 ， 用 液压 〈 或 气 ) 缸 直 接 驱动 的 腕 部 ， 一 般 具 有 两 个 自 
由 度 ， 用 机 械 传动 的 腕 部 可 具有 三 个 自由 度 。 

总 之 ,合理 地 决定 自由 度数 和 驱动 方式 ， 使 腕 部 结构 尽 可 能 紧凑 轻巧 ， 对 提高 手腕 的 动 
作 精 度 和 整个 机 械 手 的 运动 精度 和 刚度 是 极其 重要 的 。 

2) 要 适应 工作 环境 的 要 求 。 

当 机 械 手 用 于 高 温 作业 ， 或 在 腐蚀 性 介质 中 工作 ， 以 及 多 尘 、 多 杂 物 黏附 等 环境 中 
时 ， 机 械 手 的 腕 部 与 手 部 等 的 机 构 经 常 处 于 恶劣 的 工作 条 件 ， 在 设计 时 必须 充分 考虑 它 
们 对 手腕 的 不 良 影响 〈 如 热膨胀 ， 对 驱动 的 液压 油 的 秋 度 以 及 其 他 物理 化 学 性 能 的 影响 ; 
对 机 械 构件 之 间 配 合 、 材 料 性 能 的 影响 ， 对 电 测 电 控 元 件 的 耐 热 耐 蚀 性 的 影响 ， 对 活动 
部 分 的 摩擦 状态 的 影响 等 ) ， 并 预先 采取 相应 的 措施 ， 以 保证 手腕 有 良好 的 工作 性 能 和 较 
长 的 使 用 寿命 。 

3) 要 综合 考虑 各 方面 要 求 ， 合 理 布局 。 手 腕 除了 应 保证 动力 和 运动 性 能 的 要 求 ， 具 有 
足够 的 刚度 和 强度 ， 动 作 灵活 准确 以 及 较 好 地 适应 工作 条 件 等 的 影响 外 ， 在 结构 设计 中 还 应 
全 面 地 考虑 所 采用 的 各 元 器 件 和 机 构 的 特点 、 作 业 和 控制 要 求 ， 进 行 合理 布局 ， 处 理 具体 结 
构 。 例 如 ， 注 意 解决 好 腕 部 与 手 部 、 辟 部 的 连接 ， 以 及 各 个 自由 度 的 位 置 检 测 、 管 线 布置 ， 
尤其 是 通 向 手 部 的 管线 布置 ， 另 外 还 要 考虑 润滑 、 维 修 、 调 整 等 问题 。 


2. 3.3 典型 腕 部 的 结构 介绍 


1. 液压 驱动 的 回转 或 摆动 的 机 器 人 手腕 

图 2-41 所 示 为 双手 悬挂 式 机 器 人 实现 手腕 回转 和 左右 摆动 的 结构 了 示意图。 其中，4 一 4 
剖面 所 表示 的 是 液压 和 饶 外 过 转动 而 中 心 轴 不 动 ， 以 实现 手腕 的 左右 摆动 ，B 一 B 剖面 所 表示 
的 是 液压 饶 外 壳 不 动 而 中 心 轴 回 转 ， 以 实现 手腕 的 回转 运动 。 

2. 电动 机 驱动 的 机 器 人 手腕 

图 2-42 所 示 为 KUKA IR 662/100 型 机 器 人 的 手 脐 传动 原理 图 。 这 是 一 个 具有 三 个 自由 
度 的 手腕 结构 ， 关 节 配 置 形式 为 臂 转 、 腕 扫 、 手 转 结构 。 其 传动 链 分 成 两 部 分 ， 一 部 分 在 机 
器 人 小 辟 壳 内 ，3 个 电动 机 的 输出 通过 带 传动 分 别传 递 到 同 轴 传 动 的 心 轴 、 中 间 套 、 外 套 简 
上 ; 另 一 部 分 传动 链 安排 在 手腕 部 。 

3. 机 器 人 柔顺 手腕 

机 器 人 进行 精密 装配 作业 ， 当 被 装配 零件 之 间 的 配合 精度 较 高 时 ， 由 于 被 装配 零件 的 不 
一 致 性 ， 工 件 的 定位 夹具 、 机 器 人 手 不 的 定位 精度 无 法 满足 装配 要 求 ， 会 导致 装配 困难 ， 因 
而 就 提出 了 装配 动作 的 柔顺 性 要 求 。 

柔顺 性 装配 技术 有 两 种 。 一 种 是 从 检测 、 控 制 的 角度 出 发 ， 采 取 各 种 不 同 的 搜索 方法 ， 
实现 边 校 正 边 装配 ; 有 的 手 爪 还 配 有 检测 元 件 ， 如 视觉 传感器 、 力 传感器 等 ， 这 就 是 所 谓 的 
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图 2-42 KUKA IR 662/100 型 机 器 人 的 手腕 传动 原理 图 





主动 柔顺 装配 。 吃 一 种 是 从 结构 的 角度 出 发 ， 在 手腕 部 配置 一 个 柔顺 环节 ， 以 满足 柔顺 装配 
的 需要 ， 这 种 柔顺 装配 技术 称 为 被 动 柔 顺 装 配 。 

图 2-43 所 示 为 具有 移动 和 摆动 浮动 机 构 的 柔顺 手腕 。 水 平 浮 动机 构 由 平面 、 钢 球 和 弹 
簧 构成 ， 实 现在 两 个 方向 上 进行 浮动 ;摆动 浮动 机 构 由 上 、 下 球面 和 弹簧 构成 ， 实 现 两 个 方 
向 的 摆动 。 在 装配 作业 中 ， 如 遇 夹 具 定 位 不 准 或 机 器 人 手 爪 定位 不 准时 ， 可 自行 校正 。 其 动 
作 过 程 如 图 2-44 所 示 ， 在 插入 装配 中 工件 局 部 被 卡 住 时 ， 将 会 受到 阻力 ， 促 使 柔顺 手腕 起 
作用 ， 使 手下 有 一 个 微小 的 修正 量 ， 工 件 便 能 顺利 插入 。 
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必 J 
图 2-43 具有 移动 和 摆动 浮动 机 构 的 柔顺 手腕 图 2-44 柔顺 手腕 动作 过 程 
2.4 ”机 器 人 手臂 
2.4.1 概述 








机 絮 人 手 辟 是 支承 手 部 和 腕 部 ， 并 改变 手 部 空间 位 置 的 机 构 ， 是 机 器 人 的 主要 部 件 之 一 。 
一 般 有 2~3 个 自由 度 ， 即 伸缩 、 回 转 、 依 仰 或 升降 。 臂 部 的 重量 较 重 ， 受 力 一 般 也 比较 复杂 。 
在 运动 时 ， 直 接 承 受 腕 部 、 手 部 和 工件 (或 工具 ) 的 静 、 动 载荷 。 尤 其 在 高 速 时 ， 将 产生 较 
大 的 惯性 力 或 惯性 力矩 ,引起 冲击 ， 影 响 定位 的 准确 性 。 辟 部 运动 部 分 零件 的 重量 直接 影响 着 
臂 部 结构 的 刚度 和 强度 。 臂 部 一 般 与 控制 系统 和 驱动 系统 一 起 安装 在 机 号 〈 即 机 座 ) 上 。 


2. 4.2 手臂 设计 要 点 


手臂 的 结构 形式 必须 根据 机 器 人 的 运动 形式 、 抓 取 重量 、 动 作 自由 度 和 运动 精度 等 因素 
来 确定 ; 设计 时 ， 必 须 考虑 到 手臂 受 力 情况 、 导 向 装置 的 布置 、 内 部 管 路 与 手腕 的 连接 形式 
等 情况 。 为 此 ， 设 计 手 臂 时 应 注意 以 下 几 个 问题 。 

1. 手臂 应 具有 足够 的 承载 能 力 和 刚度 

由 于 机 器 人 手 部 在 工作 中 相当 于 一 个 悬臂 梁 ， 如 果 刚 度 差 ， 会 引起 手臂 在 垂直 面 内 的 弯 
曲 变形 和 侧 向 扭转 变形 ， 从 而 导致 臂 部 产生 颤动 ， 以 致 无 法 工作 。 手 臂 的 刚度 直接 影响 到 手 
臂 在 工作 中 允许 承受 的 载荷 、 运 动 的 平稳 性 、 运 动 速度 和 定位 精度 。 因 此 必要 时 手臂 要 进行 
刚度 校 核 。 为 防止 辟 部 在 运动 过 程 中 产生 过 大 的 变形 ， 手 臂 的 截面 形状 的 选择 要 合理 。 工 字 
形 截面 的 弯曲 刚度 比 圆 截 面 要 大 ， 空 心 管 的 弯曲 刚度 和 扭转 刚度 比 实心 轴 要 大 得 多 ， 所 以 党 
选用 钢管 做 臂 的 运动 部 分 ( 臂 杆 ) 和 导向 杆 ， 用 工 字 钢 和 槽 钢 做 支承 板 。 

2. 导向 性 好 

为 了 在 直线 移动 过 程 中 ,不致 发 生 相 对 转动 ， 以 保证 手 部 的 正确 方向 ， 应 设置 导向 装 
置 ， 或 设计 成 方形 、 花 键 等 形式 的 臂 杆 。 导 向 装置 的 具体 结构 形式 ， 一 般 应 根据 负载 大 小 、 
手臂 长 度 、 行 程 以 及 手臂 的 安装 形式 等 情况 来 决定 。 导 轨 的 长 度 不 宜 小 于 其 间距 的 两 倍 ， 以 
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保证 导向 ， 而 不 致 焉 斜 。 

3. 运动 要 平稳 、 定 位 精度 要 高 ， 应 注意 减轻 重量 和 运动 惯量 

要 使 运动 平稳 、 定 位 精度 高 ， 应 注意 减 小 偏重 力矩 。 所 请 偏重 力矩 ,就 是 指 臂 部 〈 包 
括 手 部 和 被 夹 物 体 ) 的 重量 对 机 身 立 柱 〈 即 对 其 支承 回转 轴 ) 所 产生 的 静 力矩 。 偏 重力 矩 
过 大 ， 易 使 臂 部 在 升降 时 发 生 卡 死 或 朴 行 ， 因 此 应 注意 减轻 偏重 力矩 ， 尽 量 减 轻 臂 部 运动 部 
分 的 重量 ,使 辟 部 的 重心 与 立柱 中 心 尽量 靠近 ， 此 外 还 可 以 采取 “ 配 重 ” 的 方法 来 减轻 和 
消除 偏重 力矩 。 


2.4.3 手臂 的 典型 结构 形式 


一 般 机 器 人 手臂 有 三 个 自由 度 ， 即 手臂 的 伸缩 、 左 右 回转 和 升降 (或 俯仰 ) 运动 。 手 
臂 回转 和 升降 运动 是 通过 机 座 的 立柱 实现 的 ， 立 柱 的 横向 移动 即 为 手臂 的 横 移 。 手 臂 的 各 种 
运动 通常 由 驱动 机 构 和 各 种 传动 机 构 来 实现 ， 因 此 它 不 仅 承受 被 抓 取 工 件 的 重量 ， 而 且 承 受 
末端 操作 器 、 手 腕 和 手臂 自身 的 重量 。 手 辟 的 结构 、 工 作 范 围 、 灵 活性 、 抓 重大 小 ( 即 辟 
力 ) 和 定位 精度 都 直接 影响 机 器 人 的 工作 性 能 。 

1. 手臂 直线 运动 机 构 

机 器 人 手臂 的 伸缩 、 升 降 及 横向 〈 或 纵向 ) 移动 均 属 于 直线 运动 ， 而 实现 手 壁 直线 往 
复 运 动 的 机 构 形 式 较 多 ， 和 常用 的 有 活塞 液压 〈 气 ) 氏 、 齿 轮 齿 条 机 构 、 丝 杠 螺母 机 构 等 。 
直线 往复 运动 可 采用 液压 或 气压 驱动 的 活塞 亿 。 由 于 活塞 液压 〈 气 ) 氏 的 体积 小 、 重 量 轻 ， 
因而 在 机 器 人 手臂 结构 中 应 用 较 多 。 图 2-45 所 示 为 双 导 向 杆 手 辟 伸缩 结构 示意 图 。 手 臂 和 
手腕 是 通过 连接 板 安装 在 升降 液压 氏 的 上 端 ， 当 双 作 用 液压 和 1 的 两 腔 分 别 通 入 液压 油 时 ， 
则 推动 活塞 杆 2 〈 即 手臂 ) 做 直线 往复 移动 。 导 向 杆 3 在 导向 套 4 内 移动 ， 以 防 手臂 伸缩 时 
的 转动 (并 兼作 手腕 回转 氏 6 及 手 部 的 夹 紧 液 压 仙 7 的 输油管 道 )。 由 于 手臂 的 伸缩 液压 饶 
安装 在 两 根 导向 杆 之 间 ， 由 导向 杆 承 受 弯曲 作用 ， 活 塞 杆 只 受 拉 压 作用 ， 故 受 力 简单 ， 传 动 
平稳 ， 外 形 整齐 美观 ， 结 构 紧 次。 












































































































































图 2-45” 双 导向 杆 手臂 伸缩 结构 示意 图 














1 一 双 作 用 液压 垂 ”2 一 活塞 杆 ”3 一 导向 杆 4 一 导向 套 5 一 支承 座 ”6 一 手腕 回转 缸 7 一 手 部 的 夹 紧 液 压 缸 
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2. 手臂 回转 运动 机 构 
实现 机 器 人 手臂 回转 运动 的 机 构 形 式 是 多 种 多 样 的 ， 


常用 的 有 叶片 式 回转 缸 、 齿 轮 传动 


机 构 、 链 轮 传动 机 构 和 连 杆 机 构 。 下 面 以 齿轮 传动 机 构 中 活塞 和 和 齿轮 齿 条 机 构 为 例 说 明 手 


壁 的 回转 。 


齿轮 齿 条 机 构 是 通过 齿 条 的 往复 移动 ， 带 动 与 手 辟 连接 的 齿轮 做 往复 回转 ， 即 可 实现 手 











辟 的 回转 运动 。 带 动 齿 条 往复 移动 的 活塞 饶 可 以 由 液压 

















I 或 压缩 气体 驱动 。 图 2-46 所 示 为 








手臂 做 升降 和 回转 运动 的 结构 示意 图 。 活 塞 液 压 饶 两 腔 分 别 进 液压 油 推动 齿 条 活塞 7 做 往复 
移动 ( 见 4 一 4 剖面 ) ， 与 齿 条 活塞 7 哮 合 的 从 5 轮 4 即 做 往复 回转 。 由 于 齿轮 4、 升 降 和 所 体 2、 
连接 板 8 均 用 螺钉 连接 成 一 体 ， 连 接 板 又 与 手臂 固 连 ， 从 而 实现 手臂 的 回转 和 运动。 升降 生体 
的 活塞 杆 通过 连接 盖 5 与 机 座 6 连接 而 固定 不 动 ， 升 降生 体 2 治 导 向 套 3 做 上 下 移动 ， 因 升 








降 币 体外 部 装 有 导向 套 ， 故 刚性 好 ， 传 动 平 稳 。 
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图 2-46 手臂 做 升降 和 回转 运动 的 结构 示意 图 








1 一 活塞 杆 “2 一 升降 全 体 ”3 一 导向 套 





4 一 齿轮 


5 一 连接 盖 6 一 机 座 7 一 齿 条 活塞 8 一 连接 板 





图 2-47 所 示 为 采用 活塞 氏 和 连 杆 机 构 的 一 种 双 辟 机 带 人 手臂 结构 示意 图 ， 手 壁 的 上 下 
摆动 由 匀 接 活塞 液压 缸 和 连 杆 机 构 来 实现 。 当 贸 接 活塞 液压 仙 1 的 两 腔 通 液压 油 时 ， 通 过 连 
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杆 2 带动 曲 杆 3 〈( 即 手臂 ) 绕 轴 心 做 90° 的 上 下 摆动 (如 图 中 细 双 点 画 线 所 示 位 置 )。 手 辟 
下 摆 到 水 平 位 置 时 ， 其 水 平和 侧 向 的 定位 由 支承 架 4 上 的 定位 螺 杀 6 和 5 来 调节 。 此 手臂 结 
构 具 有 传动 结构 简单 、 紧 凑 和 轻巧 等 特点 。 




















图 2-47 双 辟 机 器 人 手臂 结构 示意 图 
1 一 贸 接 活塞 液压 适 ”2 一 连 杆 ( 即 活塞 杆 ) ”3 一 曲 杆 ( 即 手臂 ) ”4 一 支承 架 5 .6 一 定位 螺钉 








3. 手臂 俯仰 运动 机 构 
机 器 人 手臂 的 俯仰 运动 一 般 采 用 活塞 液压 〈 气 ) 饶 与 连 杆 机 构 联 用 来 实现 。 手 壁 的 信 
仰 运动 使 用 的 活塞 币 位 于 手臂 的 下 方 ， 其 活塞 杆 和 手臂 用 铵 链 连接 ， 币 体 采 用 尾部 耳环 或 中 
部 销 轴 等 方式 与 立柱 连接 ， 如 图 2-48 和 图 2-49 所 示 。 此 外 ， 还 有 采用 无 杆 活 塞 生 驱动 具 轮 
条 或 四 连 杆 机 构 实现 手臂 俯仰 运动 的 。 




















a) b) 
图 2-48 ”驱动 氏 带 动手 臂 俯 仰 运动 结构 示意 图 
a) 驱动 氏 前 置式 结构 b) 驱动 氏 后 置式 结构 
4. 手臂 复合 运动 机 构 
手臂 的 复合 运动 机 构 ， 不 仅 使 机 器 人 的 传动 结构 简单 ， 而 且 可 简化 驱动 系统 和 控制 
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系统 ， 并 使 机 器 人 传动 准确 ， 工 作 可 靠 ， 因而 在 动 
作 程序 固定 不 变 的 专用 机 器 人 上 应 用 的 比较 多 。 除 
手臂 能 实现 复合 运动 外 ， 手 腕 与 手臂 的 运动 也 能 组 
成 复合 运动 。 

手臂 和 手臂 (或 手腕 ) 的 复合 运动 ， 可 以 由 动力 
部 件 (如 活塞 氏 、 回 转手 和 齿 条 活塞 和 等 ) 与 常用 机 
构 (如 四 权 机 构 、 连 杆 机 构 和 齿轮 机 构 等 ) 按照 手臂 
的 运动 轨迹 或 手臂 和 手腕 的 动作 要 求 进行 组 合 。 下 面 分 
别 介绍 手臂 及 手臂 与 手腕 的 复合 运动 。 

(1) 手臂 的 复合 运动 ”图 2-50a 所 示 为 曲线 四 槽 机 
构 手 臂 结 构 。 当 活塞 液压 仙 1 通 和 液压 油 时 ， 推 动 铣 有 






























































图 2-49 ” 匀 接 活塞 代 实 现 手臂 
加 权 的 》 加 定 在 前 善 









































上 ， 因 此 , 滚 套 7 在 活塞 杆 的 N 形 凹 槽 内 滚动 ， 迫 使 1 手臂 ”2 来 置 条 3 一 升降 饶 
活塞 杆 2 既 做 移动 又 做 回转 运动 ， 以 实现 手臂 4 的 复合 4 一 小 辟 ”57 一 匀 接 仙 ”6 一 大 辟 
运动 。 8 一 立柱 

活塞 杆 2 上 的 四 槽 展开 图 如 图 2-50b 所 示 。 其 中 ， 
Li 直线 段 为 机 器 人 取 料 过 程 ; 荆 曲 线段 为 机 器 人 送料 回转 过 程 ; 志 直线 段 为 机 器 人 向 卡 盘 
内 送料 过 程 。 当 机 床 扣 盘 夹 紧 工 件 后 立即 发 出 信号 ， 使 活塞 杆 反 向 运 劲 ， 退 至 原 位 等 待 上 
料 ， 从 而 完成 自动 上 料 。 

(2) 手臂 与 手 脐 的 复合 运动 图 










































































































































































































2-51 所 示 为 由 行星 齿轮 机 构 组 成 手臂 和 ee : 

手腕 回转 运动 的 结构 图 和 运动 简 图 。 如 NI/ :HH 

图 2-51a 所 示 ， 此 条 活塞 液压 饶 驱 动 圆柱 ee 22 

贞 轮 10 回转 ,经 键 5 带动 主轴 体 9 ( 即 SU gy 2 | 

行星 架 ) 回转 ， 装 在 主轴 体 9 上 的 手 部 1 SS | 

和 锥 齿轮 4 均 绕 主 轴 体 的 轴线 回转 ， 其 SS ”人 

中 锥 齿轮 4 和 锥 齿轮 12 相 哺 合 ， 而 锥 肯 ” _e、 9 -HH 

轮 12 相对 手 避 升降 液压 负 体 13 的 活塞 ,NS 

套 8 是 不 动 的 ， 因 此 ， 锥 齿轮 12 是 “ 固 ”| 和 -| 各 

定 ” 太 阳 轮 。 锥 齿轮 4 随同 主轴 体 9 线 

主轴 体 的 轴线 公转 时 ， 人 迫使 它 又 绕 自 身 ”图 2-50 用 曲线 凹 槽 机 构 实现 手臂 复合 运动 的 结构 

轴线 自转 ， 即 锥 齿轮 4 做 行星 运动 ， 故 a) 曲线 四 槽 机 构 手臂 结构 b) 四 楷 展开 图 
[ 2 一 活塞 杆 3 一 前 羡 4 一 手 辟 














称 为 行星 轮 。 欠 齿轮 4 的 自转 ,经 灸 5 
带动 手 部 1 的 夹 紧 液压 拭 2 回转 ， 即 为 

手腕 回转 运动 。 由 于 手臂 的 回转 ， 通 过 

锥 齿轮 行星 机 构 使 手腕 回转 。 图 2-51b、c、d 所 示 分 别 为 手臂 的 结构 图 、 运 动 简 图 和 矢 
量 图 。 
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图 2-51 由 行星 齿轮 机 构 组 成 手臂 和 手腕 回转 运动 的 机 构 结 构图 和 运动 简 图 
a) 手臂 和 手腕 的 结构 图 b) 手臂 的 结构 图 c) 手臂 运动 简 图 d) 手臂 矢量 图 
1 一 手 部 ”2 一 夹 紧 液压 氏 3 一 活塞 杆 4、12 一 锥 齿轮 5、11 一 键 
6 一 行程 开关 7 一 轴承 热 ”8 一 活塞 套 9 一 主轴 体 10 一 圆柱 齿轮 ”13 一 升降 液压 饶 体 





























2.5 机 融 人 的 驱动 与 传动 


2.5.1 机 器 人 常规 和 新 型 的 驱动 方式 


机 如 人 常规 的 驱动 方式 为 : 液压 驱动 、 气 压 驱 动 、 电 动 驱 动 和 混合 驱动 等 。 液 压 驱 动 以 
液压 油 为 工作 介质 。 液 压 驱 动机 融 人 的 抓 取 能 力 较 大 ， 液 压力 可 达 7MPa， 传 动 平稳 ， 但 对 
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密封 性 要 求 高 。 

气压 驱动 的 原理 与 液压 相似 ， 主 要 不 同 在 于 气压 驱动 是 靠 空气 介质 进行 工作 的 。 气压 驱 
动机 器 人 通常 结构 简单 、 动 作 迅 速 和 价格 低廉 。 由 于 空气 具有 可 压缩 性 , 因此 这 种 机 器 人 的 
工作 力 具 有 一 定 的 和 柔性， 但 速度 较 慢 ， 稳 定性 较 差 ;其 气压 一 般 为 0.7MPa， 因 而 抓 取 力 较 
小 。 由 于 气压 驱动 的 特点 ， 机 顺 人 夹 持 器 〈 或 称 为 机 械 手 ) 大 多 采用 气压 驱动 。 

电动 驱动 是 机 器 人 目前 用 得 较 多 的 一 种 驱动 方式 。 早 期 大 多 采用 步 进 电动 机 (SM) 驱 
动 ， 后 来 发 展 了 直流 伺服 电动 机 (DC)， 现 在 交流 伺服 电动 机 (AC) 也 开始 广泛 应 用 。 直 
流 伺服 电动 机 用 得 较 多 的 原因 是 因为 它 可 以 产生 很 大 的 力矩 、 精 度 高 、 反 应 快 和 可 靠 性 高 ; 
在 正 反 两 个 方向 可 以 连续 旋转 ， 运 动 平滑 ， 并 且 本 身 设 有 位 置 控 制 功 能 。 步 进 电动 机 是 通过 
脉冲 电流 实现 步 进 的 ， 每 给 一 个 脉冲 ， 便 转动 一 个 步 距 。 

也 有 的 机 带 人 将 三 种 常规 的 驱动 方式 结合 起 来 使 用 。 还 有 的 机 器 人 采用 新 型 的 驱动 方式 
了 驱动， 如 磁 致 伸缩 驱动 、 形 状 记忆 合金 驱动 、 静 电 驱 动 和 超声 波 电 动机 驱动 等 。 

1. 磁 致 伸缩 驱动 

铁 磁 材料 和 亚 铁 磁 材 料 由 于 磁化 状态 的 改变 ， 其 长 度 和 体积 都 要 发 生 微小 的 变化 ， 这 种 
现象 称 为 磁 致 伸缩 。20 世纪 60 年 代 人 们 发 现 某 些 稀 土 元 素 在 低温 时 磁 伸 率 达 3x10 一 ~1x 
10“， 开 始 关注 研究 有 实用 价值 的 大 磁 致 伸缩 材料 。 研 究 发 现 ，TbFe ( 钱 铁 ) 、SmFe; 〈 馈 
铁 ) 、DyFe。( 锁 铁 ) 、HoFe( 詹 铁 ) 和 TbDyFe ( 钠 匀 铁 ) 等 稀土 一 铁 系 化 合 物 不 仅 磁 致 伸 
缩 值 高 ， 而 且 居 里 点 高 于 室温 ， 室 温 磁 致 伸缩 值 为 1x10 ”~2.5 x10”， 是 传统 磁 致 伸缩 材 
料 〈 如 铁 、 镍 等 ) 的 10 ~ 100 信 。 这 类 材料 被 称 为 稀土 超 磁 臻 伸缩 材料 ( Rear Earth Giant 
Magneto Strictive Materials，RE-GMSM) 。 这 一 现象 已 用 于 制造 具有 微米 量 级 位 移 能 力 的 直线 
电动 机 。 为 使 这 种 驱动 带 工 作 ， 要 将 被 磁性 线圈 覆盖 的 磁 致 伸缩 小 棒 的 两 端 固定 在 两 个 架子 
上 。 当 磁场 改变 时 ,会 导致 小 棒 收缩 或 伸展 ， 这 样 其 中 一 个 架子 就 会 相对 于 男 一 个 架子 产生 
运动 。 一 个 与 此 类 似 的 概念 是 用 压 电 晶体 来 制造 具有 微米 量 级 位 移 的 直线 电动 机 。 

美国 波士顿 大 学 已 经 研制 出 了 一 台 使 用 压 电 微 型 电动 机 驱动 的 机 器 人 “机 需 蚂 
蚁 ”。“ 机 器 蚂蚁 ”的 每 条 腿 为 长 Imm 或 不 到 lmm 的 硅 杆 ， 通 过 不 带 传 动 装置 的 压 电 微型 
电动 机 来 驱动 各 条 腿 运 动 。 这 种 “机 器 蚂蚁 ”可 用 在 实验 室 中 收集 放射 性 的 人 尘埃 以 及 从 活 
着 的 病人 体 中 收取 患 病 的 细胞 。 

2. 形状 记忆 合金 驱动 

有 一 种 特殊 的 形状 记忆 合金 称 为 生物 金属 (Biometal) ， 它 可 在 达到 特定 温度 时 缩短 大 
约 4% 。 通 过 改变 合金 的 成 分 可 以 设计 合金 的 转变 温度 ， 但 标准 样品 都 将 温度 设 在 90Y 左 
右 。 在 这 个 温度 附近 ， 合 金 的 唱 格 结构 会 从 马 氏 体 状 态 变 化 到 奥 氏 体 状态 ， 并 因此 变 短 。 然 
而 ， 与 许多 其 他 形状 记忆 合金 不 同 的 是 ， 它 变 冷 时 能 再 次 回 到 马 氏 体 状态 。 如 果 线 材 上 负载 
低 的 话 ， 上 述 过 程 能 够 持续 变化 数 十 万 个 循环 。 实 现 这 种 转变 的 常用 热源 来 自 于 当 电流 通过 
金属 时 ,金属 因 自 身 的 电阻 而 产生 的 热量 。 结 果 是 ,来 自 电 池 或 者 其 他 电源 的 电流 轻易 就 能 
使 生物 金属 线 缩短 。 这 种 金属 线 的 主要 缺点 在 于 它 的 总 应 变 仅 发 生 在 一 个 很 小 的 温度 范围 
内 ， 因 此 除了 在 开关 情况 下 以 外 ， 要 精确 控制 它 的 拉力 很 困难 ， 同 时 也 很 难 控 制 位 移 。 

根据 以 往 的 经 验 ， 尽 管 生物 金属 线 并 不 适合 用 作 驱 动 器 ， 但 人 们 常 带 期 望 它 在 将 来 有 可 
能 会 变 得 有 用 。 如 果 那 样 的 话 ， 机 器 人 的 胜 膊 就 会 安 上 类 似 人 或 动物 肌肉 的 物质 ， 并 由 电流 
来 操纵 。 
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3. 静电 驱动 

静电 驱动 是 利用 电荷 间 的 吸力 和 排斥 力 的 相互 作用 来 驱动 电极 ， 从 而 产生 平移 或 旋转 的 
运动 。 因 静电 作用 属于 表面 力 ， 它 和 元 件 尺寸 的 二 次 方 成 正比 ， 在 尺寸 微小 化 时 能 够 产生 很 
大 的 能 量 。 

图 2-52 是 三 相 静 电 驱 动 需 工作 原理 示意 图 。 从 图 2-52a 可 知 ， 静 电 驱 动 融 主要 由 定子 、 
移动 子 和 绝缘 子 等 组 成 。 当 把 电压 施加 到 定子 的 电极 上 时 ， 在 移动 子 中 会 感应 出 极 性 与 其 相 
反 的 电荷 来 ， 如 图 2-52b 所 示 。 在 图 2-52c 中 , 当 定子 外 加 电压 变化 时 ， 因 为 移动 子 上 的 电 
谷 不 能 立即 变化 , 所 以 由 于 电极 的 作用 ， 移 动 子 会 受到 右上 方向 的 合力 作用 ， 了 驱动 其 向 右 方 
移动 ， 达 到 图 2- 52d 所 示 的 相对 稳定 状态 。 反 复 进 行 上 述 操作 ， 移 动 子 就 会 连续 地 回 右 方 
移动 。 

这 种 驱动 器 有 下 列 特征 : Sep a 

1) 因为 移动 子 中 没有 电极 ， 所 以 不 1 电极 定子 
必 确 定 与 定子 的 相对 位 置 ， 定 子 电极 的 
间距 可 以 非常 小 。 

2) 因为 驱动 时 会 产生 浮力 ， 所 以 摩 2 
擦 力 小 。 在 停止 时 由 于 存在 着 吸引 力 和 于 


摩擦 力 ， 因 此 可 以 获得 比较 大 的 保持 力 。 三 二 -二 一 一 于 一 二 一 一 一 一 一 
ne 





















































































































































O 十 V 

以 实现 以 薄膜 为 基础 的 大 面积 多 层 化 3 
结 构 S 全 全 

基于 上 述 特征 ， 把 这 种 驱动 器 作为 
实现 人 工 筋肉 的 一 种 方法 ， 受 到 了 人 们 oy 
的 关注 。 SY 

4. 超声 波 电 动机 驱动 -一 -一 

超声 波 电动 机 的 工作 原理 是 用 超声 
波 激励 弹性 体 定子 ， 使 其 表面 形成 椭圆 2 并 
运动 ,由 于 其 上 与 转子 (或 滑 块 ) 接 可 8 
触 ， 在 摩擦 的 作用 下 转子 获得 推力 输出 。 图 2-52 ”三 相 静 电 驱动 器 工作 原理 示意 图 








如 图 2-53 所 示 ， 可 以 认为 定子 按照 角 频 
率 wo 进行 超声 波 振动 ， 在 预 压力 WW 作用 下 ， 转 子 被 推动 。 超 声波 电动 机 的 负载 特性 与 直流 
电动 机 相似 ， 相 对 于 负载 增加 ， 转 速 有 垂直 下 降 

的 趋势 ， 将 超声 波 电动 机 与 直流 电动 机 进行 比较 ， 人 
其 特点 为 ，D 可 望 达 到 低速 和 高 效率 ，@ 同 样 的 
尺寸 ， 能 得 到 较 大 的 转 抵 ; 国 能 保持 较 大 的 转 矩 ; 
@ 无 电磁 噪声 ， 回 易 控制 ，@ 外 形 的 自由 度 大 。 


2.5.2 机 器 人 直线 传动 机 构 


机 老人 的 机 械 传动 是 指 利用 机 械 方式 传递 动 质点 的 轨迹 
力 和 运动 ， 即 将 动力 和 运动 从 一 个 位 置 传递 到 男 ”图 2-53 超声 波 电 动机 工作 原理 示意 图 






































振动 物体 (定子 ) 
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一 个 位 置 的 过 程 。 机 器 人 的 传动 方式 主要 有 三 种 : 直线 传动 、 旋 转 传动 和 混合 传动 等 。 

机 絮 人 采用 的 直线 传动 方式 包括 直角 坐标 结构 的 XX 、Y、Z 向 运动 ,圆柱 坐 标 结 构 的 径 
向 运动 和 垂直 升降 运动 ， 以 及 极 坐标 结构 的 径 向 伸缩 运动 。 直 线 运 动 可 以 直接 由 气 生 或 液压 
缸 的 活塞 产生 ， 也 可 以 采用 齿轮 齿 条 、 丝 杠 和 螺母 等 传动 机 构 及 元 件 把 旋转 运动 转换 成 直线 
运动 。 

1. 齿轮 齿 条 装置 
通常 ， 齿 条 是 固定 不 动 的 ， 当 齿轮 转动 时 ,齿轮 轴 连 同 拖 板 沿 齿 条 方向 做 直线 运动 。 
样 ， 齿 轮 的 旋转 和 运动 就 转换 成 为 拖 板 的 直线 运动 。 

2. 丝 杠 螺母 机 构 

个 旋转 的 精密 丝 杠 驱动 一 个 螺母 沿 丝 杠 轴 向 移动 。 由 于 普通 丝 杜 的 
摩擦 力 较 大 、 效 率 低 、 惯 性 大 ， 在 低速 时 容易 产生 扑 行 现象 ,而且 精度 低 ， 回 程 误 差 大 ， 因 
0 

3. 滚珠 丝 杠 机 构 

机 器 人 传动 中 经 常 采 用 滚珠 丝 栖 传动， 这 是 因为 滚珠 丝 杠 的 摩擦 力 很 小 且 运 动 响应 速度 
快 。 由 于 滚珠 丝 杠 在 丝 杠 螺母 的 螺旋 槽 里 放置 了 许多 滚珠 ， 传 劲 过 程 中 所 受 的 摩擦 是 滚动 摩 
擦 ， 可 极 大 地 减 小 摩擦 力 ， 人 
加 一 定 的 预 紧 力 ， 可 消除 回程 误差 。 


2. 5.3 机 器 人 旋转 传动 机 构 


多 数 普 通电 动机 和 伺服 电动 机 都 能 够 直接 产生 旋转 运动 ， 但 其 输出 转 矩 比 所 需要 的 转 矩 
小 ， 转 速 比 所 需要 的 转速 高 。 因 此 ， 需 要 采用 各 种 齿轮 链 、 带 传动 装置 或 其 他 运动 传动 机 
构 ， 把 较 高 的 转速 转换 成 较 低 的 转速 ， 并 获得 较 大 的 转 矩 。 有 时 也 采用 直线 液压 红 或 直线 气 
NS a De et a rt mn de 
完成 ， 并 且 不 能 有 损 于 机 器 人 系统 所 需要 的 特性 ， 特 别 是 定位 精度 、 重 复 精度 和 可 靠 性 。 

动 的 传递 和 转换 可 以 选择 齿轮 链 、 同 步 带 和 谐 波 齿轮 等 方式 。 

1. 齿轮 链 机 构 

齿轮 链 是 由 两 个 或 两 个 以 上 的 齿轮 组 成 的 传动 机 构 。 它 不 但 可 以 传递 运动 角 位 移 和 和 角 速 
度 ， 而 且 可 以 传递 力 和 转 矩 。 

使 用 齿轮 链 机 构 应 注意 两 个 问题 ,一 是 齿轮 链 的 引入 会 改变 系统 的 等 效 转动 惯量 ， 从 而 
使 驱动 电动 机 的 响应 时 间 缩 短 ， 这 样 伺服 系统 就 更 加 容易 控制 。 输 出 轴 转 动 惯量 转换 到 驱动 
电动 机 上 ， 等 效 转动 惯量 的 下 降 与 输入 /输出 齿轮 齿 数 的 平方 成 正比 。 二 是 在 引入 齿轮 链 的 
同时 ， 由 于 齿轮 间隙 误差 ， 将 会 导致 机 器 人 手臂 的 定位 误差 增加 ; 而 且 ， 假 如 不 采取 一 些 补 
救 措施 ， 齿 隙 误差 还 会 引起 伺服 系统 的 不 稳定 性 。 

2. 同步 带 机 构 

同步 带 类 似 于 工厂 的 风扇 传动 带 和 其 他 传动 带 ， 所 不 同 的 是 这 种 同步 带 上 具有 许多 型 
齿 ， 它 们 和 同样 具有 型 齿 的 同步 带 轮 齿 相 喘 合 。 工 作 时 ， 它 们 相当 于 柔软 的 齿轮 ， 具 有 柔性 
好 、 价 格 便宜 等 优点 。 另 外 ， 同 步 带 还 被 用 于 输入 轴 和 和 输出 轴 方 向 不 一 致 的 情况 。 这 时 ， 只 
要 同步 带 足 够 长 ， 且 同步 带 的 扭 角 不 太 大 ， 则 同步 带 仍 能 够 正常 工作 。 在 伺服 系统 中 ， 如 果 
输出 轴 的 位 置 采 用 码 盘 测量 ， 则 输入 传动 的 同步 带 可 以 放 在 伺服 环 外面 ， 这 对 系统 的 定位 精 
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度 和 重复 精度 不 会 有 影响 ， 重 复 精 度 可 以 达到 lmm 以 内 。 此 外 ， 同 步 带 比 齿轮 链 价格 低 得 
多 ， 加 工 也 容易 得 多 。 有 了 时， 齿轮 链 和 同步 带 结 合 起 来 使 用 更 为 方便 。 

3. 谐 波 齿轮 机 构 

目前 ， 机 器 人 的 旋转 关节 大 多 都 采用 谐 波 齿 轮 传动 。 谐 波 齿轮 传动 机 构 主 要 由 刚 轮 
1、 柔 轮 2 和 谐 波 发 生 器 3 等 零件 组 成 ， 如 图 2-54 所 示 。 工 作 时 ， 刚 轮 固定 安装 ， 各 具 均 
布 于 圆周 ， 具 有 外 人 齿 形 的 柔 轮 沿 刚 轮 的 内 齿 转 动 。 当 柔 轮 比 刚 轮 少 两 个 齿 时 ， 柔 轮 沿 刚 
轮 每 转 一 圈 就 相当 于 反方 向 转 过 两 个 齿 的 相应 转角 。 谐 波 发 生 器 具有 椭圆 形 轮廓 ， 装 在 
谐 波 发 生 器 上 的 滚珠 用 于 支承 和 柔 轮 ， 谐 波 发 生 器 驱动 柔 轮 旋转 并 使 之 发 生变 形 。 转 动 时 ， 
柔 轮 的 椭圆 形 端 部 只 有 少数 齿 与 刚 轮 吵 合 ， 只 有 这 样 ， 柔 轮 才能 相对 于 刚 轮 自由 地 转 过 
一 定 的 角度 。 

假设 刚 轮 有 100 个 上 从， 柔 轮 比 它 少 2 个 齿 ， 则 当 谐 波 
发 生 器 转 50 圈 时 ， 柔 轮转 1 圈 ， 这 样 只 占用 很 小 的 空间 
就 可 得 到 1 : 50 的 减速 比 。 由 于 同时 吵 合 的 齿 数 较 多 ， 
此 谐 波 发 生 器 的 转 矩 传递 能 力 很 强 。 在 刚 轮 、 柔 轮 和 谐 波 
发 生 器 中 ， 尽 管 任何 两 个 都 可 以 选 为 输入 元 件 和 输出 元 
件 ， 但 通常 总 是 把 谐 波 发 生 需 装 在 输入 轴 上 ， 把 柔 轮 装 在 
输出 轴 上 ， 以 获得 较 大 的 齿轮 减速 比 。 

由 于 自然 形成 的 预 加 载 谐 波 发 生 需 路 合 齿 数 较 多 ， 以 
及 齿 的 哮 合 比较 平稳 ， 谐 流 齿 轮 传动 的 齿 际 几乎 为 零 ， 因 
此 谐 波 齿轮 传动 精度 高 ， 回 程 误 差 小 。 但 是 ， 柔 轮 的 刚性 。 图 2-54 谐 波 齿 轮 传动 示意 图 
较 差 ， 承载 后 会 出 现 较 大 的 扭转 变形 ， 引 起 一 定 的 误差 ， 1 一 刚 轮 2 一 柔 轮 3 一 谐 波 发 生 器 
对 于 多 数 应 用 场合 ， 这 种 变形 不 会 引起 太 大 的 问题 ， 不 影 
响 工 程 上 的 使 用 。 


2. 5.4 机 器 人 制 动 装置 


机 天 人 的 机 械 臂 大 多 需要 在 各 关节 处 安装 制 动 装置 (简称 为 制动器 ) 。 其 作用 为 : 在 机 
器 人 停止 工作 时 ， 保 持 机 械 臂 的 位 置 不 变 ; 在 电源 发 生 故障 时 ， 保 护 机 械 臂 和 它 周 围 的 物体 
不 发 生 碰撞 。 假 如 齿轮 链 、 谐 波 齿 轮机 构 和 深 珠 丝 杠 等 元 件 的 质量 较 高 ， 一 般 其 摩擦 力 都 很 
小 ， 在 驱动 右 停 止 工作 时 ， 它 们 是 不 能 承受 负载 的 。 如 果 不 采用 某 种 外 部 固定 装置 ， 如 制 动 
带 、 夹 紧 右 或 止 挡 装置 等 ,一 旦 电源 关闭 ， 机 融 人 的 各 个 部 件 就 会 在 重力 的 作用 下 滑落 。 因 
此 ， 为 机 器 人 设计 制 动 装置 是 十 分 必要 的 。 

制 动 品 通常 是 按 失 效 抱 闹 方式 工作 的 ， 即 要 松 开 制 动 咒 就 必须 接 通电 源 ， 和 否则 ， 各 关节 
不 能 产生 相对 运动 。 这 种 方式 的 主要 目的 是 在 电源 出 现 故障 时 起 保护 作用 ， 其 缺点 是 在 工作 
期 间 要 不 断 通 电 使 制动器 松 开 。 假 如 有 需要 ， 也 可 以 采用 一 种 省 电 的 方法 ， 其 原理 是 : 需要 
各 关节 运动 时 ， 先 接 通电 源 ， 松 开 制动器 ， 然 后 接 通 另 一 电源 ， 驱 动 一 个 挡 销 将 制动器 锁 在 
放松 状态 。 这 样 ， 所 需要 的 电力 仅仅 是 把 挡 销 放 到 位 所 花费 的 电力 。 

为 了 使 关节 定位 准确 ， 制动器 必须 有 足够 的 定位 精度 。 制 劲 器 应 当 尽 可 能 地 放 在 系统 的 
驱动 输入 端 ， 这 样 利 用 传动 链 速 比 ， 能 够 减 小 制动器 的 轻微 滑动 所 引起 的 系统 振动 ， 保 证 在 
承载 条 件 下 仍 具有 较 高 的 定位 精度 。 在 实际 应 用 中 ， 许 多 机 器 人 都 采用 了 制动器 。 
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2.6 本 竟 小 结 





本 章 介绍 了 机 器 人 机 械 系 统 的 组 成 ， 分 析 了 机 器 人 的 机 座 、 手 部 、 胸 部 、 臂 部 、 驱 动 和 
传动 机 构 等 的 工作 原理 、 结 构 特 点 和 设计 要 求 。 通 过 本 章 机 器 人 机 械 系统 的 学 习 ， 使 读者 能 
够 了 解 和 掌握 机 器 人 机 械 系 统 的 一 般 结 构 和 工作 原理 ,为 机 器 人 后 续 的 运动 学 、 动 力学 和 控 
制 系统 等 的 学 习 提供 了 理论 基础 。 











习 题 


2-1 机 器 人 机 械 系统 由 哪儿 部 分 组 成 ? 各 部 分 具有 哪些 作用 ? 
2-2 机 天 人 移动 机 座 可 分 为 哪 几 类 ? 

2-3 ”机 器 人 末端 操作 器 可 分 为 哪 几 类 ? 

2-4 机 器 人 胸部 和 臂 部 的 设计 要 点 各 有 哪些 ? 

2-5 机 器 人 驱动 方式 有 哪些 ? 
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早 在 1955 年 ，J. Denavit 和 R. S. Hartenberg 首次 提出 了 一 种 采用 人 矩阵 代数 的 方法 ， 即 
用 齐 次 矩阵 (D-H 矩阵 ) 来 描述 机 构 连 杆 之 间 的 空间 几何 关系 。 齐 次 矩阵 是 一 个 4x4 斥 阵 ， 
它 可 把 一 个 矢量 从 一 个 坐标 系 转换 到 为 一 个 坐标 系 之 中 。 该 矩阵 可 同时 实现 旋转 和 平移 的 变 
换 。 在 机 器 人 空间 机 构 的 运动 学 和 动力 学 分 析 方 法 中 ， 齐 次 变换 是 较 直观 和 方便 的 一 种 方 
法 ， 它 为 机 器 人 的 分 析 和 控制 提供 了 一 种 有 效 的 手段 。 


3.1 机 器 人 位 置 和 姿态 的 表示 


机 器 人 操作 壁 ， 通 常 由 一 系列 连 杆 和 相应 的 运动 附件 组 成 ， 实 现 复 杂 的 运动 ， 完 成 规定 
的 操作 。 若 要 研究 机 器 人 的 运动 和 操作 ， 就 要 描述 这 些 连 杆 之 间 ， 以 及 它们 和 操作 对 象 
(或 运动 目标 ) 之 间 的 相对 运动 关系 。 在 描述 机 器 人 位 置 和 姿态 〈 简称 位 姿 ) 时 ， 要 建立 一 
个 坐标 系 ; 在 该 坐标 系 中 ,机 器 人 的 位 姿 可 用 齐 次 变换 来 描述 。 齐 次 变换 既 有 较 直观 的 几何 
意义 ， 又 可 描述 各 杆 件 之 间 的 关系 ， 因 此 常用 于 解决 机 器 人 运动 学 问题 。 


3. 1.1 点 的 位 置 描述 


在 关节 型 机 器 人 的 位 姿 控 制 中 ， 首 先 要 描述 各 连 杆 的 位 置 ， 为 此 先 定义 一 个 固定 坐标 
系 。 一旦 建立 了 坐标 系 ， 就 能 用 一 个 3x1 的 位 置 拓 量 对 坐标 系 中 的 任何 一 点 进行 定位 ， 如 
图 3-1 所 示 。 在 直角 坐标 系 中 ， 空 间 任 一 点 P 的 位 置 可 用 3x1 的 位 置 矢量 p 表示 。 


a 


x 


p= DO (3-1) 


C 


Zz 


其 中 , a,、5,、c. 是 点 P 的 三 个 位 置 坐标 分 量 。 
3. 1.2 物体 姿态 描述 


为 了 描述 空间 物体 的 姿态 ， 需 在 物体 上 建立 一 个 坐标 系 ， 并且 给 出 此 坐标 系 相对 于 参考 
坐标 系 的 表达 。 在 图 3-2 中 ， 已 知 坐标 系 1 B| 以 某 种 方式 固定 在 物体 上 ， 则 18| 相对 于 
固定 参考 坐标 系 14} 中 的 描述 ， 可 以 表示 出 物体 相对 固定 参考 坐标 系 14| 的 姿态 。 

上 述 表 明 ， 点 的 位 置 可 用 矢量 描述 。 同 样 ， 物 体 的 姿态 可 用 固定 在 物体 上 的 坐标 系 来 描 
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到 3-1 点 的 位 置 描述 图 3-2 物体 姿态 的 描述 





述 。 设 1B| 中 的 单位 主 矢量 为 x、o、a， 当 用 坐标 系 14} 的 坐标 来 表达 时 ， 它 们 写成 
4n 4o a。 则 这 三 个 单位 矢量 可 排列 组 成 一 个 3x3 和 矩阵， 称 这 个 矩阵 为 旋转 和 矩阵， 用 符号 
4R 来 表示 。 


R=[4n “0 44]=|m oo (3-2) 
这 样 一 组 矢量 可 以 用 来 描述 一 个 物体 的 姿态 。 
旋转 矩阵 4R 是 单位 正 交 的 ， 并 是 4R 的 逆 与 它 的 转 置 相同 ， 其 行列 式 值 等 于 1， 即 
sR =pR' |sR|=1 (3-3) 
在 运动 学 分 析 中 ， 经 常用 到 的 旋转 变换 矩阵 是 绕 x 轴 、 绕 y 轴 或 绕 z 轴 旋 转 某 一 角度 0 
的 变换 和 矩阵， 分别 可 以 用 式 (3-4) 、 式 (3-5) 和 式 (3-6) 表示 。 


[1 0 0 

R(x,0)=|0 cosO0 加 (3-4) 
LO sing cosO 
| cosg 0 sing 

R(y,0)=| 0 1 0 (3-5) 
| -sin0 0 cos0 
| cos0 -sing 0 

R(z,0)= | sing cosb | (3-6) 





[0 0 1 


3. 1.3 坐标 系 的 描述 
如 图 3-2 所 示 ， 为 了 描述 物体 在 空间 的 位 姿 ， 需 要 规定 它 的 位 置 和 姿态 。 通 常 将 物体 与 
坐标 系 18} 固 连 。 坐 标 系 1B| 的 原点 一 般 选 在 物体 的 特征 点 上 ， 如 质心 或 对 称 中 心 等 。 
相对 参考 坐标 系 14} 用 位 置 撩 量 p 来 描述 坐标 系 1B} 原点 的 位 置 ， 而 用 旋转 矢量 $6R 来 描 
述 坐 标 系 |B| 的 姿态 (方位 ) ， 因 此 坐标 系 1B} 可 由 p 和 8R 来 描述 。 
1B} =|8R,p| (3-7) 
坐标 系 的 描述 概括 了 物体 位 置 和 姿态 的 描述 。 当 表示 位 置 时 ， 式 (3-7) 中 的 旋转 矩 
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$R=1 (单位 和 矩阵) ; 当 表 示 姿 态 时 ， 式 (3-7) 
由 式 (3-1) 和 式 (3-2) 可 知 ， 坐 标 系 1B| 


中 的 位 置 矢量 p=0。 
就 可 以 由 三 个 表示 方向 的 单位 矢量 以 及 第 


四 个 位 置 撩 量 来 表示 。 


Ny Ox Ux Ux 


{B} = ny, 0, Qay DO 


1z 0 4 Cz 


在 式 (3-8) 中 ， 前 三 个 矢量 是 方向 矢量 ， 表 示 该 坐标 系 1B| 的 三 个 单位 矢量 n、o、 
a 的 方向 ， 而 第 四 个 矢量 表示 该 坐标 系 1B} 的 原点 相对 于 参考 坐标 系 14} 的 位 置 。 此 坐 
标 系 是 由 一 个 3x4 和 矩阵 表示 。 

例 3-1 在 图 3-3 中 ,FF 坐标 系 位 于 参考 坐标 系 中 (3，5，7) 的 位 置 ， 它 的 n 轴 与 x 轴 
平行 ，o 轴 相 对 于 y 轴 的 角度 为 45°% ，a 轴 相 对 于 z 轴 的 角度 为 44"。 试 用 一 个 3x4 矩阵 来 表 
示 该 坐标 系 。 

解 : 由 式 (3-8) 知 ,， 该 坐标 系 可 表示 为 


(3-8) 




















1 0 0 3 
有 =|0 0.707 -0.707 5 
0 0.707 0.707 7 








3.2 章 次 坐标 与 动 系 的 位 姿 表示 





3.2.1 





点 的 齐 次 坐标 

将 一 个 n 维 空间 的 点 用 n+1 维 坐标 表示 ， 则 该 w+1 
维 坐 标 即 为 n 维 空 间 的 齐 次 坐标 。 一 般 情况 下 ， 设 w 为 该 齐 次 坐标 的 比例 因子 ， 当 取 w=1 
时 ， 其 表示 方法 称 为 齐 次 坐标 的 规格 化 形式 。 

若 用 四 个 数组 成 的 4x1l 阵列 表示 图 3-1 中 点 P， 则 该 阵列 称 为 三 维 空间 点 已 的 齐 次 
坐标 。 


图 3-3 坐标 系 在 空间 的 示意 图 





CQx 多 
这 
PP=| :， -| (3-9) 
Cz 
1 CU 


其 中 ,，x=wa,， 
显然 ， 齐 次 坐标 表达 并 不 是 唯一 的 ， 随 w 值 的 不 同 而 不 同 。 如 果 w 是 1， 各 分 量 的 大 小 
保持 不 变 。 但 是 ， 如 果 w=0， 则 a,，5,，c; 为 无 穷 大 。 在 这 种 情况 下 ，*，y 和 z (以 及 &a,， 
5,，c;) 表示 一 个 长 度 为 无 穷 大 的 矢量 ， 它 的 方向 即 为 该 矢量 所 表示 的 方向 。 这 就 意味 着 方 
向 矢量 可 以 由 比例 因子 w=0 的 矢量 来 表示 ， 这 里 矢量 的 长 度 并 不 重要 ， 而 其 方向 由 该 矢量 
的 三 个 分 量 来 表示 。 在 计算 机 图 学 中 ，w 作为 通用 比例 因子 ， 可 取 任 意 正 值 ， 但 在 机 器 人 的 
运动 分 析 中 ， 总 是 取 w=1。 


y=wb,, z=wWc,o 
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3. 2. 2 ”坐标 轴 方 向 的 描述 


如 图 3-4 所 示 ， 用 i、j、k 来 表示 直角 坐标 系 中 x、y、z 坐标 轴 的 单位 矢量 ， 用 齐 次 坐 
标 来 描述 x、y、z 轴 的 方向 ， 则 有 





i=| ,=| ,| ,k= 





1 0 0 
0 1 0 
0 0 1 
0 0 0 
图 3-4 中 所 示 矢 量 v 的 单位 矢量 h 的 方向 阵列 为 
h=[a bc 0]'=[cos@ cosB cosy 0]' (3-10) 
其 中 ,a、B、y 分 别 是 矢量 ” 与 坐标 轴 x、y、z 的 夹 角 ， 
0°*<a<180°, 0° <B <180°, 0° <Yy 180°, cosa、 cosb、 
cosy 称 为 矢量 ”的 方向 余弦 ， 且 满足 cos*a+cos"B+cos“y=1。 
综 上 所 述 ， 可 得 如 下 结论 : 
1) 阵列 [la be 0] 中 第 四 个 元 素 为 零 ， 目 a2+b?+ 
c=1， 则 a、5、c 表示 某 轴 (或 某 矢量 ) 的 方向 。 
2) 阵列 [a ec w]' 中 第 四 个 元 素 不 为 零 ， 则 表示 空 图 3-4 坐标 轴 的 描述 
间 某 点 的 位 置 。 
3) 表示 坐标 原点 的 4xl 阵列 定义 为 : o=[000a]j'(a 关 0)。 
例如 ， 在 图 3-2 中 ， 矢 量 ”的 方向 用 4xl 列 阵 表示 为 
v=[a b c¢ 0 

















其 中 ,a=cosa, b=cosB,，c=cosy。 
矢量 "的 起 点 0 为 坐标 原点 ， 用 4x1 阵列 可 表示 为 
o=[0 0 0 1]7 
当 a=30°, B=60°, y=45° 时 ， 矢 量 为 
v= [0.866 0.5 0.707 0]7 


3. 2.3 齐 次 坐标 与 三 维 直 角 华 标的 区 别 


P 点 在 Oxyz 坐标 系 中 表示 是 唯一 的 (x，y，z) ， 而 在 齐 次 坐标 中 表示 可 以 是 多 值 的 。 
几 个 特定 意义 的 齐 次 坐标 表示 如 下 : 











[0 0 0 nj] 一 一 坐标 原点 矢量 的 齐 次 坐标 ,，n 为 任意 非 零 比例 系数 ; 
[1 0 0 0]" 一 一 指向 无 穷 远 处 的 Ox 轴 ; 
[0 1 0 0]" 一 一 指向 无 穷 远 处 的 0y 轴 ; 
[0 0 1 0]" 一 一 指向 无 穷 远 处 的 0z 轴 。 





3. 2.4 动 系 的 位 姿 表 示 


在 坐标 系 中 ， 相 对 连 杆 不 动 的 坐标 系 称 为 静坐 标 系 〈 简 称 静 系 ) ; 跟随 连 杆 运动 的 坐标 
系 称 为 动 坐 标 系 ( 简称 动 系 ) 。 动 坐标 系 位 姿 的 描述 就 是 用 位 姿 矩 阵 对 动 坐 标 系 原 点 位 置 和 
坐标 系 各 坐标 轴 方 向 进行 描述 。 
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1. 刚体 的 位 姿 描 述 
机 器 人 的 每 一 个 连 杆 均 可 视 为 一 个 刚体 ， 若 给 定 
刚体 上 某 一 点 的 位 置 和 该 刚体 在 空中 的 姿态 ， 则 这 
刚体 在 空间 上 是 唯一 确定 的 ， 可 用 唯一 一 个 位 姿 矩 
阵 进行 描述 。 

如 图 3-5 所 示 ， 固 连 在 刚体 上 的 空间 坐标 系 ( 动 
系 ) 0'x'y'z' 可 以 用 和 矩阵 表示 ， 其 中 坐标 原点 0' 以 及 相 
对 于 参考 坐标 系 表示 该 坐标 系 姿态 的 三 个 矢量 也 可 以 
用 和 矩阵 表示 出 来 。 

由 此 ， 刚 体 在 固定 坐标 系 中 的 位 置 可 用 一 齐 次 坐 
标 表 示 为 





他 





1 
刚体 的 姿态 可 用 动 系 坐标 轴 方 向 来 表示 。 令 n、o、 





向 矢量 ， 即 
n= A 人 a= 
0 0 
由 此 可 知 ， 刚 体 的 位 姿 和 矩阵 可 用 式 (3-12) 表示 。 
nN Ox 
T=[n o a p]=|) a 
0 0 


2. 手 部 位 姿 的 描述 


(@ 
O'(x0,y0, 20) 








图 3-5 刚体 的 位 置 和 姿态 描述 


a 分 别 为 x*、y'、z' 坐 标 轴 的 单位 方 


CQx 
a,, 

和 (3-11 ) 
Qz 

0 

Cx Xo 

ei (3-12) 
Qs: 20 

0 1 


机 器 人 手 部 的 位 姿 如 图 3-6 所 示 ， 可 用 固 连 于 手 部 的 坐标 系 |1B| 的 位 姿 来 表示 。 


在 图 3-6 所 示 坐 标 系 中 ， | B| 由 原点 位 置 
和 三 个 单位 矢量 唯一 确定 。 

1) 原点 : 取 手 部 中 心 点 为 原点 Op。 

2) 接近 矢量 : 关节 轴 方 向 的 单位 矢量 a。 

3) 姿态 矢量 : 手指 连 线 方向 的 单位 


[a 
里 0o 


4) 法 向 矢量 : n 为 法 向 单位 矢量 ， 同 时 垂 
直 于 a 矢量 和 o 矢量 ， 即 n=oxa。 

手 部 位 姿 和 撩 量 为 从 固定 参考 坐标 系 Oxyz 原 
点 指向 手 部 坐标 系 1B) 原点 的 矢量 p。 






































图 3-6 手 部 位 姿 的 描述 
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手 部 位 姿 可 由 式 (3-13) 中 的 4x4 矩阵 表示 ， 即 


T=[ln o a pl= (3-13) 


3. 目标 物 位 姿 的 描述 
任何 一 个 物体 在 空间 的 位 姿 都 可 以 用 齐 次 矩阵 来 表示 ， 如 图 3-7 所 示 。 例 如 ， 模 块 0 在 
图 3-7 中 ,可 用 6 个 点 描述 ， 矩阵 表达 式 为 





1 -1 -1 1 1 -1l 

Ga i 
0 
le ty a 


知 让 模块 绕 z 轴 旋 转 90"， 即 Rot (z，90°); 再 绕 y 轴 旋 转 90*， 即 Rot (y，90°), 然 
后 再 沿 xx 轴 方 向 平移 4， 即 Trans (4，0，0) ， 则 模块 成 为 图 3-7b 所 示 位 姿 ， 其 齐 次 矩阵 表 
达 式 为 


4 4 6 6 4 4 
1 -1 -1 1 1 -1 

L470 0 0 04 4 tn 
1 i 








图 3-7 模块 0 位 姿 的 齐 次 矩阵 


3.3 齐 次 坐标 变换 


当空 间 的 一 个 坐标 系 〈 一 个 矢量 、 一 个 物体 或 一 个 运动 坐标 系 ) 相对 于 固定 参考 坐标 
系 运 动 时 ， 这 一 运动 可 以 用 类 似 于 坐标 系 的 方式 来 表示 。 这 是 因为 变换 本 身 就 是 坐标 系 状态 
的 变化 〈 表 示 坐 标 系 位 姿 的 变化 ) ， 因 此 变换 可 以 用 坐标 系 来 表示 。 在 机 器 人 中 ,手臂 、 手 
腕 等 被 视 为 刚体 的 连 杆 的 运动 ， 一 般 包 括 平移 运动 、 旋 转运 动 和 平移 加 旋转 运动 。 
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3.3.1 平移 变换 


如 果 一 坐标 系 〈 它 也 可 能 表示 一 个 物体 ) 在 空间 以 不 变 的 姿态 运动 ， 那 么 该 坐标 系 就 
是 做 平移 运动 。 在 这 种 情况 下 ， 它 的 方向 单位 矢量 保持 同一 方向 不 变 。 所 有 的 改变 只 是 坐标 











图 3-8 坐标 平移 变换 的 表示 





系 原 点 相对 于 参考 坐标 系 的 变化 ， 如 图 3-8 所 示 。 相 对 于 固定 参考 坐标 系 的 新 的 坐标 系 的 位 
置 可 以 用 原来 坐标 系 的 原点 位 置 失 量 加 上 表示 位 移 的 矢量 求 得 。 若 用 矩阵 形式 ， 新 坐标 系 的 
表示 可 以 通过 坐标 系 左 乘 变换 矩阵 得 到 。 由 于 在 平移 中 方向 矢量 不 改变 ， 变 换 和 矩阵 了 可 以 
简单 地 表示 为 











Trans(d_ ,d_ ,d )= (3-16) 


CR 


OO OO 一 


0 0 
1 0 
0 1 
0 0 0 1 
其 中 ，4d, ，d, ，d, 是 平移 矢量 4 分 别 相对 于 参考 坐标 系 x，y，z 轴 的 三 个 分 量 。 可 以 看 
到 ， 和 矩阵 的 前 三 列表 示 没 有 旋转 运动 ， 而 最 后 一 列表 示 平 移 运动 。 新 的 坐标 系 位 置 为 


1] 0 0 dad, n, oO a. Px n, o. a, pritd, 
着 0 1 0 dd, nm ooy or Py|_|ny 0 a py+td, ey 
™ 0 0 1 d, nN, 0; Zz Ps nN, 0; CQz ps+td, 
0 0 0 1 0 0 0 1 0 0 0 1 
式 (3-17) 也 可 用 符号 写 为 
Fv =Trans( d, ,dy ,d;,) xFa (3-18) 


其 中 ，Trans (d,，d,，d.) 称 为 平移 算 子 (用 于 坐标 系 间 变换 的 通用 数学 表达 式 称 为 
算 子 )，d,，d,，d, 分 别 表 示 沿 x*、y、z 轴 的 移动 量 。 

知 算 子 左 乘 ， 则 表示 点 的 平移 是 相对 固定 坐标 系 进行 的 坐标 变换 ; 若 算 子 右 乘 ， 则 表示 
点 的 平移 是 相对 动 坐标 系 进 行 的 坐标 变换 。 

例 3-2 ”坐标 系 忆 沿 参考 坐标 系 的 x 轴 移 动 9 个 单位 , 沿 z 轴 移动 5 个 单位 。 求 新 的 坐 
标 系 位 置 。 





0.527 -0.574 0.628 5 
0.369 0.819 0.439 3 

| 8 
1 


-0. 700 0 0. 043 
0 0 0 
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解 : 由 式 (3-17) 或 式 (3-18) 得 
Fs = Trans(d,,d,,d,) XxF a=Trans(9,0,5)xF,a 
0 0 9 0.527 -0.527 0.628 5 
0 0 0.369 0.819 0.439 3 
1 5| |-0.766 0 0.643 8 
0 1 0 0 0 1 


0 1 
0 
0 
9 -0.527 0.628 14 


new 0 
0 


0.369 0.819 0.439 3 
-0. 760 0.643 13 
0 1 


3. 3. 2 旋转 变换 


1. 绕 坐 标 轴 的 旋转 变换 

为 简化 绕 轴 旋转 的 推导 ， 首 先 假设 该 坐标 系 位 于 参考 坐标 系 的 原点 并 且 与 之 平行 ， 之 后 
将 结果 推广 到 其 他 的 旋转 以 及 旋转 的 组 合 

假设 坐标 系 〔n，0o，4) 初始 位 置 和 参考 坐标 系 x，y，z) 重合 ， 当 坐标 系 (n，o， 
a) 绕 参 考 坐 标 系 的 * 轴 旋 转 一 个 角度 0; 再 假设 旋转 坐标 系 (n,，o，a) 上 有 一 点 P 相对 于 
a id Ai ss me 
系 (n, 0o, a) 绕 xx 轴 旋转 时 ,该 坐标 系 上 的 点 PP 也 随 坐 标 系 一 起 旋转 。 在 旋转 之 前 ，P 点 
在 两 个 坐标 系 中 的 坐标 是 相同 的 (这 时 两 个 坐标 系 位 置 相同 )。 旋 转 后 ， 该 点 坐标 (PP,， 
P,，P,) 在 旋转 坐标 系 (x ，y ，z) 中 保持 不 变 , 但 在 参考 坐标 系 中 (P,，P,，P,) 却 改 
变 了 ， 如 图 3-9 所 示 。 现 在 要 求 找到 运动 坐标 系 旋转 后 ， 点 P 相对 于 固定 参考 坐标 系 的 新 
坐标 。 

从 x 轴 来 观察 在 二 维 平面 上 的 同一 点 的 坐标 ， 图 3-9 显示 了 点 在 坐标 系 旋转 前 后 的 坐 
标 。 点 尸 相对 于 参考 坐标 系 的 坐标 是 〈P,，P,，P.) ， 而 相对 于 旋转 坐标 系 (点 尸 所 固 连 的 
坐标 系 ) 的 坐标 仍 为 (P,,，P,,，P,)。 

由 图 3-9 可 以 看 出 ，P, 不 随 坐 标 系 x 轴 的 转动 而 改变 ， 而 已 和 P, 却 改 变 了 。 

P=P, 
P,=P,cos0-P,sind (3-19) 
P,.=P,sin0-—P,cos0 
































写成 矩阵 形式 为 
1 0 0 02 
0 cos0 -sing 0|1|P 
0 0 |1| 己 
1 


(3-20) 


P 
Pp, 
P sin0 cos0 
1 0 0 0 1 
可 见 ， 为 了 得 到 在 参考 坐标 系 中 的 坐标 ， 旋 转 坐 标 系 中 的 点 已 (或 矢量 己 ) 的 坐标 必须 
左 乘 旋转 矩阵 。 这 个 旋转 矩阵 只 适用 于 绕 参 考 坐 标 系 x 轴 做 旋转 变换 的 情况 ， 它 可 表示 为 
P,.=Rot(x,0)xP (3-21) 





noa 
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> 
> 











图 3-9 点 的 旋转 变换 
a) 旋转 前 b) 旋转 后 


注意 : 在 式 (3-21) 中 ，Rot (*，0) 表示 坐标 变换 时 绕 x 轴 转 动 的 齐 次 变换 和 矩阵， 称 
为 旋转 算 子 ， 旋 转 和 矩阵 的 第 一 列表 示 相 对 于 x 轴 的 位 置 ， 其 值 为 (1，0，0) ， 它 表示 沿 * 轴 
的 坐标 没有 改变 。 

为 简化 书写 ， 习 惯用 符号 c6 表示 cos6， 以 及 用 56 表示 sing。 因 此 ， 旋 转 和 矩阵 也 可 写 为 

1 0 0 0 

Rot(x.0)= 0 c0O -s0 0 (3.22) 
0 50 ec0 0 
0 0 0 1 


可 用 同样 的 方法 来 分 析 坐 标 系 绕 参考 坐标 系 y 轴 和 z 轴 旋 转 的 情况 。 


| cg 0 ss 0 
0 1 0 
Rot(y,0)= (3-23) 
-SO 0 co 


[Lo 0 


ee 


s0 co 
0 0 
10 0 0 


式 (3-21) 也 可 写 为 习惯 的 形式 ， 以 便于 理解 不 同 坐 标 系 间 的 关系 ， 为 此 ， 可 将 该 变换 
表示 为 "Th [ 读 作 坐标 系 RR 相对 于 坐标 系 VU (Universe) 的 变换 ] ， 将 已 .表示 为 *P (P 相对 
于 坐标 系 RR) ， 将 P,, 表 示 为 "P(P 相对 于 坐标 系 UV) ， 式 (3-21) 可 简化 为 

vp=VT,xtP (3-25) 

由 式 (3-25) 可 知 ， 去 掉 R 便 得 到 了 P 相对 于 坐标 系 U 的 坐标 。 

2. 绕 过 原点 任意 轴 的 一 般 旋转 变换 (通用 旋转 变换 ) 

图 3-10 所 示 为 点 4 绕 任意 过 原点 的 单位 矢量 旋转 0 角 的 情况 。k,、hk,、, 分 别 为 k 矢 
量 在 固定 参考 坐标 轴 x、y、z 上 的 三 个 分 量 ， 且 成 + 如 + 如 =1。 其 旋转 齐 次 变换 矩阵 为 


0 

[ce -50 0 
0 

Rot(z,0)= i 


(3-24) 
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kk(1-cO) tc kk(l-c0) -ks0 kk (1l-c0)+k,s0 0 
kk (1-cO)+hs0 kk(l-cO)+tc0 kk (1l-c0)-ks0 0 
kk(1-cO0) -ks kk(1l-cO)+thks0 kk(l-c0)+c0 0 

0 0 0 1 
注意 : 1) 式 (3-26) 为 一 般 旋 转 齐 次 变换 通 式 ,概括 了 绕 x、y、z 轴 进 行 旋转 变换 的 
特殊 情况 。 


Rot(k,0)= (3-26) 

















当 友 = 1 =h=0 时 ， 即 为 绕 * 轴 旋 转 6， 可 得 式 让 有 
(3-22); 当 拟 =1, =k,=0 时 ， 即 为 绕 y 轴 旋 转 0， 可 得 式 。 
(3-23); 当 玉 =1,， 及 = 及 =0 时， 即 为 绕 z 轴 旋 转 9， 可 得 式 
(3-24) 。 。 
反之 ， 若 给 出 某 个 旋转 齐 次 变换 矩阵 ， 则 可 求 得 大 及 转 
角 0。 / - 
n. o. a. 0 
例如 ;车 给 出 某 个 施 转 箱 阵 R=|” “” * 
nz 0 a 0 图 3-10 一 般 旋 转变 换 
0 0 0 1 


则 根据 式 (3-26) 可 求 出 等 效 转角 0 及 等 效 转轴 矢量 上 为 





1 
sind = + (0.-4y) +(a ns) +(n,-o0,)” 











0 (0,-0)) +( a -ns) + os) 0 
n+0,+a,—1 
人 ee 0 (3.28) 
” 2sing ?7 2sin0 “ 2sin0 


其 中 ， 当 转角 0 取 0*~180* 时 ， 式 中 的 符号 取 “+” 号 ; 当 转 角 0 很 小 时 ， 公 式 很 难 确 
定 转轴 ; 当 0 接近 0 或 180* 时 ， 转 轴 完 全 不 确定 。 

2) 旋转 算 子 式 (3-22) ~ 式 (3-24) 和 通用 旋转 算 子 式 (3-26) 不 仅 适 用 于 点 的 旋转 ， 
也 适用 于 矢量 、 坐 标 系 和 物体 的 旋转 变换 计算 。 

3) 算 子 左 乘 是 相对 固定 坐标 系 的 变换 ， 算 子 右 乘 是 相对 动 坐标 系 的 变换 。 

例 3-3 旋转 坐标 系 中 有 一 点 P [2 3 4]7， 此 坐标 系 绕 参 考 坐 标 系 x* 轴 旋 转 90"。 求 
旋转 后 该 点 相对 于 参考 坐标 系 的 坐标 。 

解 : 由 于 点 尸 固 连 在 旋转 坐标 系 中 ， 因 此 点 P 相对 于 旋转 坐标 系 的 坐标 在 旋转 前 后 保 
持 不 变 。 该 点 相对 于 参考 坐标 系 的 坐标 为 





六 [Lo 0 olPf|l rl1o 0 opF2 
P| |0 cg -0P I0 0 -03 |-4 
P| Ios cog 0llp| lo 1 0 0|4| 13 
1| L100 0 boo ULUa 


根据 前 面 的 变换 ， 得 到 旋转 后 P 点 相对 于 参考 坐标 系 的 坐标 为 (2，-4，3)。 
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3.3.3 复合 变换 


复合 变换 是 由 固定 参考 坐标 系 或 当前 运动 坐标 系 的 一 系列 治 轴 平 移 和 绕 轴 旋转 变换 所 组 
成 的 。 任 何 变换 都 可 以 分 解 为 按 一 定 顺序 的 一 组 平移 和 旋转 变换 。 例 如 ， 为 了 完成 所 要 求 的 
变换 ， 可 以 先 绕 x 轴 旋 转 ， 再 沿 x，y，z 轴 平 移 ， 最 后 绕 y 轴 旋 转 。 在 后 面 将 会 看 到 ， 这 个 
变换 顺序 很 重要 ， 如 果 颠 倒 两 个 依次 变换 的 顺序 ， 结 果 将 会 完全 不 同 。 

为 了 探讨 如 何 处 理 复 合 变换 ， 假 定 坐标 系 (nm ，o，%) 相对 于 参考 坐标 系 (*，y，z) 
依次 进行 了 下 面 三 个 变换 : 中 绕 * 轴 旋 转 w; 人 @) 接 着 平移 [1 ， 5 3] (分 别 相对 于 x，y，z 
轴 ) ; @) 最 后 绕 y 轴 旋 转 B。 

例如 ， 点 Pu 固定 在 旋转 坐标 系 ， 开 始 时 旋转 坐标 系 的 原点 与 参考 坐标 系 的 原点 重合 。 
随 着 坐标 系 (n，o，a) 相对 于 参考 坐标 系 旋转 或 者 平移 ， 坐 标 系 中 的 已 点 相对 于 参考 坐标 
系 也 跟着 改变 。 如 前 面 所 看 到 的 ， 第 一 次 变换 后 ,，P 点 相对 于 参考 坐标 系 的 坐标 可 用 下 列 方 
程 进 行 计算 。 














P, .=Rot(x,a)xP 


1 ,xyz 
其 中 ，P, 是 第 一 次 变换 后 该 点 相对 于 参考 坐标 系 的 坐标 。 第 二 次 变换 后 ， 该 点 相对 
于 参考 坐标 系 的 坐标 是 


P, ,=Trans (li, bs, 13)xP, ,=Trans (li, bs, Ll3)xRot (x, a)xP 
同样 ， 第 三 次 变换 后 ， 该 点 相对 于 参考 坐标 系 的 坐标 为 


Po=P3 oz=Rot (y, B) XP, ,= Rot (y, B) xTrans (1, l,， /3 ) xRot (%, a)xP 


noa 


noa 


可 见 ， 每 次 变换 后 该 点 相对 于 参考 坐标 系 的 坐标 都 是 通过 用 每 个 变换 矩阵 左 乘 该 点 的 坐 
标 得 到 的 。 当 然 ， 矩阵 的 顺序 不 能 改变 。 同 时 还 应 注意 ， 对 于 相对 于 参考 坐标 系 的 每 次 变 
换 ， 和 矩阵 都 是 左 乘 的 。 因 此 ， 和 矩阵 书写 的 顺序 和 进行 变换 的 顺序 正好 相反 。 

例 3-4 固 连 在 坐标 系 (n, o, a) 上 的 点 已 7 3 2)7 经历 如 下 变换 : (D 绕 z 轴 旋转 
90°; 人 @) 接 着 绕 y 轴 旋 转 90°;，(3) 接 着 再 平移 [4 -3 7]。 求 出 经 变换 后 ， 该 点 相对 于 参考 
坐标 系 的 坐标 。 

解 : 表示 该 变换 的 矩阵 方程 为 


P,.= Trans(4,-3,7)XxRot(y,90°)xRot(z,90°)xP 














noa 


1 0 0 4 0 0 1 0 0 -1 0 0| [7 6 

0 1 0 -3 0 1 0 0 1 0 0 0 3 4 
x x x 二 

0 0 1 7 -1 0 0 0 0 0 1 0 2 10 

000 1 0 00 1 0 0 0 1 1 1 





例 3-5 根据 上 例 ， 假 定 (n,，o,a) 坐标 系 上 的 点 P(7 3 2)7 经历 相同 变换 ， 但 变 
换 按 如 下 不 同 顺序 进行 ， 求 出 变换 后 该 点 相对 于 参考 坐标 系 的 坐标 。 中 绕 z 轴 旋 转 90°; 
@) 接 着 平移 [4 -3 7]; @ 接 着 再 绕 y 轴 旋 转 90°。 

解 : 表示 该 变换 的 矩阵 方程 为 
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P= Rot(y,90°)xTrans(4,-3,7)xRot(z,90°)xP 


noa 


0 01olfl100 41ro -10 0|7r7 
jo 100|1010 -3||1 0 00|1|3 
"10o0o00oo01 7| 0 010 2 

0 .00 11l1000 1|1|10 0 01|1.1 





不 难 发 现 ， 尽 管 所 有 的 变换 与 例 3-4 完全 相同 ， 但 由 于 变换 的 顺序 变 了 ， 该 点 最 
与 前 例 完 全 不 同 。 


3. 3.4 相对 于 旋转 坐标 系 的 变换 


到 目前 为 止 ， 所 讨论 的 所 有 变换 都 是 相对 于 固定 参考 坐标 系 。 也 就 是 说 ， 所 有 平移 、 旋 
转 都 是 相对 参考 坐标 系 的 。 然 而 事实 上 ， 也 有 可 能 做 相对 于 运动 坐标 系 或 当前 坐标 系 的 轴 的 
变换 。 例 如 ， 可 以 相对 于 运动 坐标 系 的 n 轴 而 不 是 参考 坐标 系 的 x 轴 旋 转 90"。 为 计算 当前 
坐标 系 中 的 点 的 坐标 相对 于 参考 坐标 系 的 变化 ， 需 要 右 乘 变换 和 矩阵 而 不 是 左 乘 。 由 于 运动 坐 
标 系 中 的 点 或 物体 的 位 置 总 是 相对 于 运动 坐标 系 测量 的 ， 所 以 总 是 右 乘 描 述 该 点 或 物体 的 位 
置 和 矩阵 。 

例 3-6 假设 与 例 3-5 中 相同 的 点 现在 进行 相同 的 变换 ， 但 所 有 变换 都 是 相对 于 当前 的 
运动 坐标 系 ， 具 体 变换 如 下 : 岂 绕 a 轴 旋 转 90"; @ 然 后 沿 n，o，a 轴 平 移 [4 -3 7]; 
(3 接着 绕 。 轴 旋 转 90"。 求 出 变换 完成 后 该 点 相对 于 参考 坐标 系 的 坐标 。 

解 : 在 本 例 中 ， 因 为 所 作 变 换 是 相对 于 当前 坐标 系 的 ， 因 此 右 乘 每 个 变换 矩阵 ， 可 得 表 
示 该 坐标 的 方程 为 

P,,.=Rot(a,90°)xTrans(4,-3,7)xRot(o,90°)xP 




















noa 


0 -1 0 0|]f100 4 0 0 1 0] [77 ro 
1 0 00|1010 -3||0 100||3| 16 
i 

0 0 01||1000 1 0 00 1||1| 1|1 





可 见 ， 该 例 结果 与 其 他 各 例 完全 不 同 。 不 仅 因 为 所 作 变 换 是 相对 于 当前 坐标 系 的 ， 而 且 
也 因为 矩阵 顺序 的 改变 。 

例 3-7 坐标 系 |B| 绕 x 轴 旋 转 90"， 然 后 沿 当 前 坐标 系 a 轴 平 移 3， 然 后 再 绕 z 轴 旋 转 
90"， 最 后 治 当前 坐标 系 。 轴 平 移 5。 

(1) 写 出 描述 该 运动 的 方程 。 

(2) 求 坐 标 系 中 的 点 已 (1，5$，4) 相对 于 参考 坐标 系 的 最 终 位 置 。 

解 : 相对 于 参考 坐标 系 以 及 当前 坐标 系 的 运动 是 交替 进行 的 。 

(1) 相应 地 左 乘 或 右 乘 每 个 运动 矩阵 ， 得 到 

“7 = 了 Rot(z,90?") xRot(x,90") xTrans(0,0,3)xTrans(0,5,0) 

代入 具体 的 矩阵 并 将 它们 相 乘 ， 得 到 





(2 


Waa 


0 -1 0 0 1 0 0 0 1 0 0 0 1 0 0 0 

1 0 0 0 0 -1 0 0 1 0 0 0 1 0 5 
P="T3 XeP= x x x 

0 0 1 0 0 1 0 0 0 0 1 3 0 0 1 0 

0 0 0 1 0 0 0 1 0 0 0 1 0 0 0 1 
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001 7 
| 
io 10 10 

0 .00 1 


3. 3.5 旋 量 的 概念 


旋 量 Screw (k, r，%p) 表示 沿 左 轴 移 动 >， 并 绕 上 轴 转 动 p 角 的 综合 齐 次 变换 。 


一 = 


这 旺 





Screw (上 ，r，9p) 与 移动 和 转动 发 生 的 先后 次 序 无 关 ， 只 要 它们 连续 即 可 ， 即 
Screw(k,r,p)= Rot(k,p)Trans(k,r)= Trans(k,r) Rot(k,9) 





例如 ， 沿 z 轴 移动 -， 并 绕 z 轴 转 动 p 角 的 综合 变换 为 


cp -sp 0 01 0 0 0 cp 
sp cp 00I10 10 0| sp 
0 0 10|l00 17| 10 
0 0 0 1||l0001| 10 
其 中 ， c 表示 COS, 5§ 表示 sin。 

3. 3.6 齐 次 变 


如 设 坐标 系 让 是 1 先 沿 
式 为 





Xi CosO 
y; sinO 
中 0 

1 0 


由 此 可 见 ， 复 合 变换 的 齐 次 坐标 方程 为 


cosO 
_| sing 
”| 0 
0 
将 该 齐 次 变换 矩阵 分 块 有 
cosO -Sing0 
sin0 cosO 
区 
3 


从 上 述 分 块 矩 阵 可 看 到 : 左上 角 的 3x3 


量 平移 ， 


(3-29) 
-sp 0 0 fF1 0 0 Olfep -sp 0 0 
op 00| 010 0llsp ep 00 
0 1 rio01rlo 0 10 
0 01||1000 1||0 0 01 


换 矩 阵 〈 位 姿 矩 阵 ) 的 写法 及 含义 


再 绕 z 轴 旋 转 0 角 ， 则 其 坐标 变换 写成 矩阵 形 
sin0 0 py ||x 
cos0 0 P | y 

0 1 pl||z 

0 0 1L1 

-sin0 0 P， 

cos0 0 p, 

0 1 pp, 

0 0 1 

0 :;p, 

Oip,| [Re p， 

| (3-30) 

1 :Pp; 0 :1 

0i1 


和 矩阵 是 两 个 坐标 系 之 间 的 旋转 变换 和 矩阵， 描述 


姿态 关系 ; 右上 角 的 3x1 矩阵 是 两 个 坐标 系 之 间 的 平移 变换 和 矩阵， 描述 位 置 关 系 。 


由 此 可 得 齐 次 变换 矩阵 的 通 式 为 
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n, 0.， pa i R, ,p; 

Ue -| 这 全 (3-31) 
dp gp De el 
0 0 0il 


| 的 原点 在 1 中 的 三 个 坐标 分 量 ，; 
| 的 x 轴 对 站 的 三 个 方向 余弦 ; 
| 的 y 轴 对 | 的 三 个 方向 余弦 ; 


式 中 ps, p,, Pp: 一 一 |j 





ny, ny, 


7 
O07%, O0,, Oz 
Cz 





1 
XxX? 和 {J 
1 





Qa,, Q,, | 的 z 轴 对 {i 的 三 个 方向 余弦 。 
任何 一 个 齐 次 坐标 变换 矩阵 均 可 分 解 为 一 个 平移 变换 矩阵 与 一 个 旋转 变换 矩阵 的 乘积 。 
0 0 Dim oaw， 0 





1 
0 
0 


i TY A 


1 
0 1 0 y Qi 

i 0 Wy Pel O00 1 Bll 
0 0 0 


3.4 ”变换 窍 阵 的 逆 变 换 


由 于 在 机 融 人 分 析 中 有 很 多 地 方 要 用 到 和 矩阵 的 逆 ， 在 下 面 的 例子 中 可 以 看 到 一 种 涉及 变 
换 和 矩阵 的 情况 。 在 图 3-11 中 ， 假 设 机 器 人 要 在 零件 已 上 钻 孔 而 需 向 零件 忆 处 移动 。 机 器 人 
基 座 相对 于 参考 坐标 系 0 的 位 置 用 坐标 系 R 来 描述 ， 机 器 人 手 用 坐标 系 五 来 描述 ， 末 端 执 
行 器 〈 即 用 来 钻 孔 的 锁 头 的 末端 ) 用 坐标 系 五 来 描述 ， 零 件 的 位 置 用 坐标 系 己 来 描述 。 钻 
和 孔 的 点 的 位 置 与 参考 坐标 系 U0 可 以 通过 两 个 独立 的 路 径 发 生 联系 ， 一 个 是 通过 该 零件 的 路 
径 ， 男 一 个 是 通过 机 融 人 的 路 径 。 因 此 ， 可 以 写 出 式 (3-32)。 
07 = TART ET =°T,?T, (3-32) 
这 就 是 说 ,该 零件 中 点 的 位 置 可 以 通过 从 U0 变换 到 P， 并 从 P 变换 到 来 完成 ; 或 
者 从 U 变换 到 RR， 从 展 变换 到 妃 , 再 从 五 变换 到 来 完成 。 























图 3-11 全 局 坐标 系 、 机 融 人 坐标 系 、 手 坐标 系 、 零 件 坐标 系 及 末端 执行 器 坐标 系 











实际 上 ， 由 于 在 任何 情况 下 机 器 人 的 基 座 位 置 在 安装 时 就 是 已 知 的 ， 因 此 变换 “7 ( 坐 
标 系 R 相对 于 坐标 系 U0 的 变换 ) 是 已 知 的 。 例 如 ， 一 个 机 器 人 安装 在 一 个 工作 台 上 ， 由 于 
它 被 紧 固 在 工作 台 上 ， 所 以 它 的 基 座 的 位 置 是 已 知 的 。 即 使 机 器 人 是 可 移动 的 ， 或 放 在 传送 
带 上 ， 因 为 控制 器 始终 掌控 着 机 器 人 基 座 的 运动 ， 因 此 它 在 任意 时 刻 的 位 置 也 是 已 知 的 。 由 
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于 用 于 末端 执行 器 的 任何 器 械 都 是 已 知 的 ， 而 且 其 尺寸 和 结构 也 是 已 知 的 ， 所 以 42Tj (机 器 
人 末端 执行 器 相对 于 机 器 人 手 的 变换 ) 也 是 已 知 的 。 此 外 ,"T。( 零件 相对 于 全 局 坐标 系 的 
变换 ) 也 是 已 知 的 ， 还 必须 要 知道 将 在 其 上 面 销 孔 的 零件 的 位 置 ， 该 位 置 可 以 通过 将 该 零 
件 放 在 钻 模 上 ， 然 后 用 视觉 系统 等 仪器 来 确定 。 最 后 需要 知道 零件 上 钻 孔 的 位 置 ， 所 以 ”75 
也 是 已 知 的 。 此 时 ， 唯 一 未 知 的 变换 就 是 *Tj， (机 器 人 手相 对 于 机 器 人 基 座 的 变换 )。 因 此 ， 
必须 找 出 机 器 人 的 关节 变量 (机 器 人 旋转 关节 的 角度 以 及 滑动 关节 的 连 杆 长 度 ) ， 以 便 将 来 
端 执 行 器 定位 在 要 钻 孔 的 位 置 上 。 可 见 ， 必 须要 计算 出 这 个 变换 ， 它 指出 机 器 人 需要 完成 的 
工作 。 后 面 将 用 所 求 出 的 变换 来 求解 机 器 人 关节 的 角度 和 连 杆 的 长 度 。 
不 能 像 在 代数 方程 中 那样 来 计算 这 个 矩阵， 即 不 能 简单 地 用 方程 的 右边 除 以 方程 的 左 
边 ， 而 应 该 用 合适 的 矩阵 的 逆 并 通过 左 乘 或 右 乘 来 将 它们 从 左边 去 掉 。 
(Tr) (Tr TH Te) (TE) = Ta) (Tp TE) (TE) (3-33) 
由 于 (“Tr)” ("Tr) =1 和 (® Ts) ("Tsp) =1, 式 (3-33) 的 左边 可 简化 为 *Ts， 于 是 
可 得 


























RT ST TT Ta (3-34) 
该 方程 的 正确 性 可 以 通过 认为 5T 与 ("7s) -! 相 同 来 加 以 检验 。 因 此 ， 该 方程 可 描述 为 
RT =0T UT ?TIT ,=RT, OT, TET, =RT， (3-35) 





显然 ， 为 了 对 机 天 人 运动 学 进行 分 析 ， 需 要 能 够 计算 变换 矩阵 的 逆 。 
下 面 我 们 讨论 关于 绕 * 轴 的 简单 旋转 矩阵 的 求 逆 计算 情况 。 











首先 绕 x 轴 的 旋转 矩阵 为 
1 0 0 
Rot(x,0)=|0 cg -s0 
0 50 co 








采用 以 下 步骤 来 计算 矩阵 的 逆 : 

1) 计算 和 矩阵 的 行列 式 。 

2) 将 矩阵 转 置 。 

3) 将 转 置 矩 阵 的 每 个 元 素 用 它 的 子 行列 式 (伴随 矩阵) 代 蔡 。 

4) 用 转换 后 的 矩阵 除 以 行列 式 。 

通过 以 上 计算 步骤 首先 可 以 得 到 旋转 矩阵 的 行列 式 的 值 ; 
A=1(c20+s20)+0=1 





旋转 矩阵 的 转 置 矩阵 为 


1 0 0 
er cg 4 (3-36) 
0 -SO co 
现在 计算 式 (3-36) 中 每 一 个 子 行列 式 (伴随 矩阵) 。 例 如 ， 元 素 (2，2) 的 子 行列 式 
是 c9-0=c0， 元 素 (1，1) 的 子 行列 式 是 c29+s20=1。 可 以 注意 到 ， 这 里 的 每 一 个 元 素 的 子 
行列 式 与 其 本 身 相 同 ， 因 此 有 





Rot (*,0)1I， = 了 Rot (x,0) 


minor 


由 于 原 旋转 矩阵 的 行列 式 为 1， 因 此 用 Rot (x，9) 同和 矩阵 除 以 行列 式 仍 得 出 相同 的 结 
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果 。 因 此 ， 关 于 x 轴 的 旋转 矩阵 的 逆 的 行列 式 与 它 的 转 置 矩 阵 相 同 。 
Rot (x,0)-1=Rot(xz,O0)T (3-37 ) 

具有 这 种 特征 的 矩阵 称 为 西 矩 阵 ， 也 就 是 说 所 有 的 旋转 抢 阵 都 是 西 矩 阵 。 因 此 ， 计 算 旋 
转 抢 阵 的 逆 就 是 将 该 矩阵 转 置 。 同 样 ， 关 于 7y 轴 和 =z 轴 的 旋转 矩阵 同样 也 是 西 和 矩阵 。 

应 注意 ， 只 有 旋转 矩阵 才 是 西 矩 阵 。 如 果 一 个 矩阵 不 是 一 个 简单 的 旋转 和 矩阵， 那么 它 也 
许 就 不 是 西 和 矩阵。 

以 上 结论 只 对 简单 的 不 表示 位 置 的 3x3 旋转 和 矩阵 成 立 。 对 一 个 齐 次 的 4x4 变换 矩阵 而 
言 ， 它 的 求 逆 可 以 将 和 矩阵 分 为 两 部 分 。 和 矩阵 的 旋转 部 分 仍 是 西 矩 阵 ， 只 需 简 单 的 转 置 ， 和 矩阵 
的 位 置 部 分 是 矢量 p 分 别 与 n, o, a 矢量 点 积 的 负 值 。 

例如 : 坐标 系 | 让 变换 到 坐标 系 | 刘 的 变换 矩阵 为 


Fe Sy hE R; ps 
n, 0, a,. pp; 0 1 


根据 上 述 方法 得 其 逆 矩 阵 为 























Pa 0o. 0, 0 -po 区 | (3.38) 
1 

L0 0 0 1 

如 上 所 示 ， 矩阵 的 旋转 部 分 是 简单 的 转 置 ， 位 置 部 分 由 点 乘 的 负 值 代 替 ， 而 最 后 一 
(比例 因子 ) 则 不 受 影 响 。 这 样 做 对 于 计算 变换 抢 阵 的 逆 是 很 方便 的 ， 而 直接 计算 4x4 矩阵 
的 逆 是 比较 麻烦 的 。 

例 3-8 计算 表示 Rot (x*，40") 一 的 矩阵 。 

解 : 绕 x 轴 旋 转 40? 的 矩阵 为 











1 0 0 0 

0 0.766 -0.643 0 
Rot(x,40°)= 

0 0.643 0.766 0 

0 0 0 1 


1 
Rot(x.40°) -1= 0 0.766 0.643 
ot(x, 
0 -0.643 0.766 
0 


例 3-9 计算 如 下 变换 矩阵 的 逆 。 


i 


0.5 0 0.866 3 
0.866 0 -5 2 
| 0 1 0 5 
0 0 0 1 
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解 : 变换 矩阵 的 逆 为 


[0.5 0.866 0 -(3x0.5+2x0.866+5x0) 
i 0 0 1 —(3x0+2x0+5x1) 
0.866 -0.5 0 -(3x0.866+2x-0.5+5x0) 
| 0 0 0 1 
「 0.5 0.866 0 -3.23 
| 0 0 1 -5 
|0.866 -0.5 0 -1.598 
0 0 0 1 





例 3-10 一 个 具有 六 个 自由 度 的 机 器 人 的 第 五 个 连 杆 上 装 有 了 照相机， 照相 机 观察 物体 
并 测定 它 相对 于 照相 机 坐标 系 的 位 置 ， 然 后 根据 以 下 数据 来 确定 未 端 执 行 器 要 到 达 物 体 所 必 
须 完 成 的 运动 。 


0 0 -1 3 0 -1 0 0 
We a | a YD 
“m1 0 0 5 0 0 1 4 
0 0 0 1 0 0 01 
0 0 12 1000 
1002|， 0 100 
mo104 Tlo o 13 
0 0 01 0 0 01 


解 : 参照 式 (3-32) ， 可 以 写 出 一 个 与 它 类 似 的 方程 ， 将 不 同 的 变换 和 坐标 系 联系 在 
一 起 。 
XXX 
由 于 方程 两 边 都 有 *T3， 所 以 可 以 将 它 消去 。 除 了 “7 之 外 所 有 剩 下 的 矩阵 都 是 已 
知 的 。 


E cd = Ce cam —E Hn | cam 
7wi= TE x Ty x TemxX 7wi = Thx Tsx TnX To 


i 00 完 0 询 
a 0 1 0 0 0 
0 0 1 .=3 0 0 dad 
000 1 0 001 
将 矩阵 及 矩阵 的 逆 代 入 前 面 的 方程 ， 得 
[1 00 oo 10 oo 0 -13foo12 
| ol1oo0 2: 
0 0 | 泛 
3 Eh | 
[2 
了 um 5 
信和 兴 这 





59 

















| 工业 机 器 人 及 其 应 用 





3.5 本 竟 小 结 


本 章 首先 介绍 了 关于 位 置 、 姿 态 和 位 姿 ， 以 及 齐 次 坐标 的 概念 ; 然后 介绍 了 平移 和 旋转 
的 基本 知识 ， 以 及 平移 和 旋转 变换 的 一 般 情 况 ; 还 介绍 了 一 个 包括 位 置 和 姿态 的 4x4 齐 次 
变换 矩阵 ; 最 后 介绍 了 变换 矩阵 的 逆 阵 。 


习 题 
3-1 0' 与 0 初始 重合 ，Y>o' 做 如 下 运动 : 中 绕 z 轴 转 动 30"; 书 绕 x 轴 转 动 60°; 


地 绕 y 轴 转 动 90。。 求 变换 矩阵 T。 
3-2 矢量 p 在 0o' 中 表示 为 p,=3i'+27'+2k’，5o' 相 对 于 区 o 的 齐 次 变换 为 








0 -1 0 10 

1 0 0 20 
TT, 三 

0 0 1 1 

0 0 0 1 


求 : 1) 画 出 Zo' 在 之 o 中 的 位 次 ; 2) 求 pyxw 在 之 o 中 的 矢量 py。; 3) 当 o' 绕 3o 的 y 轴 
转动 90?, 绕 0 的 x 轴 转 动 20" 时 , 求 pyvw 在 之 o 中 的 矢量 。 
0 1 0 0 
0 0 -1 0 
3-3 已 知 旋转 变换 矩阵 R (f，0) = i 求 有 效 转轴 了 和 有 效 转角 0 值 。 
0 0 0 1 
3-4 ”坐标 系 1B| 起 初 与 固定 坐标 系 | 0| 相 重合 ， 现 坐标 系 1B| 绕 zj 轴 旋 转 30°*， 然 后 
绕 旋 转 后 的 动 坐标 系 的 xp 轴 旋 转 43"。 试 写 出 该 坐标 系 的 起 始 和 矩阵 表达 式 和 最 后 矩阵 表 
达 式 。 
3-5 ”计算 如 下 变换 和 矩阵 的 逆 。 











0.866 -0.5 0 11.0 

| 0.5 0.866 0 -3.0 

| 0 0 1 9.0 
0 0 0 1 
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机 器 人 是 由 若干 个 连 杆 和 关节 等 所 联系 起 来 的 一 种 开 式 链 ， 其 一 端 固 接 在 机 座 上 ， 田 一 
端 安装 有 末端 操作 器 (或 称 为 手 部 )。 要 实现 对 机 器 人 在 空间 运动 轨迹 的 控制 ， 完 成 预定 的 
作业 任务 ， 就 必须 知道 机 器 人 手 部 在 空间 瞬时 的 位 置 与 姿态 。 如 何 计 算 机 器 人 手 部 在 空间 的 
位 次 是 实现 对 机 器 人 的 控制 首先 要 解决 的 问题 。 

本 章 主要 讨论 机 器 人 运动 学 的 基本 问题 ， 利 用 “D-H” (Denavit-Hartenberg) 参数 法 ， 
进行 机 器 人 的 位 姿 分 析 ; 介绍 机 器 人 正 向 与 逆向 运动 学 的 基础 知识 ; 建立 及 分 析 机 器 人 雅 可 
比 矩 阵 。 


























4.1 机 器 人 运动 学 方程 的 建立 


4. 1.1 连 杆 参数 及 连 杆 坐标 系 的 建立 


假设 机 器 人 由 一 系列 关节 和 连 杆 组 成 。 这 些 关 节 可 能 是 滑动 (线性) 的 或 旋转 (转动) 
的 。 它 们 可 以 按 任 意 的 顺序 放置 ， 并 人 处 于 任意 的 平面 。 连 杆 也 可 以 是 任意 的 长 度 (包括 
零 ) ， 它 可 能 是 弯曲 的 或 扭曲 的 ， 也 可 能 位 于 任意 平面 上 。 为 此 ， 需 要 给 每 个 关节 指定 一 个 
参考 坐标 系 ， 然 后 确定 从 一 个 关节 到 下 一 个 关节 (一 个 坐标 系 到 下 一 个 坐标 系 ) 来 进行 变 
换 的 步骤 。 如 果 从 基 座 到 第 一 个 关节 ， 再 从 第 一 个 关节 到 第 二 个 关节 ， 直 至 到 最 后 一 个 关节 
的 所 有 变换 结合 起 来 ， 就 得 到 了 机 器 人 的 总 变换 矩阵 。 

图 4-1 表示 了 三 个 顺序 的 关节 和 两 个 连 杆 。 这 些 关 节 可 能 是 旋转 的 、 滑 动 的 或 两 者 都 
有 。 尽 管 在 实际 情况 下 ， 机 器 人 的 关节 通常 具有 一 个 自由 度 ， 但 图 4-1 中 的 关节 可 以 表示 
一 个 或 两 个 自由 度 。 

图 4-1a 表示 了 三 个 关节 ， 每 个 关节 都 是 可 以 转 劲 或 平移 的 。 第 一 个 关节 指定 为 关节 m， 
第 二 个 关节 为 n+1， 第 三 个 关节 为 n+2。 在 这 些 关 节 的 前 后 可 能 还 有 其 他 关节 。 连 杆 也 是 如 
此 表示 ， 连 杆 n 位 于 关节 与 n+1 之 间 ， 连 杆 n+1 位 于 关节 n+l 与 n+2 之 间 。 在 图 4-1a 
中 ,9 角 表 示 绕 z 轴 的 旋转 角 , a 表示 每 一 条 公 重 线 的 长 度 ( 即 为 连 杆 长 度 ) ，d 表示 在 z 轴 
上 两 条 相 邻 的 公 重 线 之 间 的 距离 〈 即 为 连 杆 间距 离 ) ， 角 a 表示 两 个 相 邻 的 z 轴 之 间 的 角度 
(也 称 为 连 杆 扭 角 ) 。 这 样 每 个 连 杆 可 由 四 个 参数 来 描述 ， 其 中 a 和 角 a 是 连 杆 尺寸 参数 ， 
男 两 个 参数 表示 连 杆 与 相 邻 连 杆 的 连接 关系 。 当 连 杆 n 旋转 时 ，0, 随 之 改变 , 为 关节 变量 ， 
其 他 三 个 参数 不 变 ， 当 连 杆 进 行 平移 运动 时 ，d,, 随 之 改变 ， 为 关节 变量 ， 其 他 三 个 参数 不 
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关节 7 关节 n+1 _ 关节 +2 

















Zit Zn Znt1 
Un+tl Untl 
ntl Yatl 和 Xntl 
Onr1 
Xn 
b) ©) d) 
Zn+1 Zn Zn+tl Zn Zntl2n 
n+l 
Xntl Xn+tl Xntl 
©) f) 8) 





图 4-1 连 杆 坐标 系 建立 示意 图 


变 。 因 此 ， 通 常 只 有 0 和 4d 是 关节 变量 。 确 定 连 杆 的 运动 类 型 ， 同 时 根据 关节 变量 ， 即 可 设 
计 关 节 运 动 副 ， 从 而 进行 整个 机 器 人 的 结构 设计 。 如 果 已 知 各 个 关节 变量 的 值 ， 便 可 从 基 座 
固定 坐标 系 通 过 连 杆 坐 标 系 的 传递 ， 推 导出 手 部 坐标 系 的 位 姿 形 态 。 

为 了 用 “D-H” 表 示 法 对 机 器 人 建 模 ， 首 先 要 为 每 个 关节 建立 一 个 附 体 的 动 坐标 系 。 因 
此 ， 对 于 每 个 关节 ， 都 必须 指定 一 个 z 轴 和 x 轴 , y 轴 按 右手 螺旋 法 则 确定 。 以 下 是 给 每 个 
关节 指定 动 坐标 系 的 步骤 : 

1) 连 杆 n 坐标 系 的 坐标 原点 位 于 n+1 关节 轴线 上 ， 是 关节 n+1 的 关节 轴线 与 n 和 n+1 
关节 轴线 公 垂 线 的 交点 。 

2) z 轴 与 n+1 关节 轴线 重合 。 如 果 关 节 是 旋转 的 ，z 轴 方 向 按 右 手 规则 确定 ， 四 指 指向 
旋转 方向 ， 则 拇指 的 指向 即 为 z 轴 的 方向 ， 如 果 关 节 是 滑动 的 ，z 轴 方 向 为 沿 直线 运动 的 方 
向 。 关 节 nn 处 的 z< 轴 (以 及 该 关 广 的 动 坐 标 系 ) 的 下 标 为 n-1。 例 如 ， 表 示 关 节 n+1 的 z 轴 
是 zz。 

3) x 轴 与 公 垂 线 重合 ， 从 nn 指向 ntl 关节。 如 果 两 个 关节 的 z 轴 平 行 ， 那么 它们 之 间 
就 有 无 数 条 公 垂 线 。 这 时 可 选 与 前 一 关节 的 公 垂 线 共 线 的 一 条 公 垂 线 ， 这 样 可 以 简化 模型 ， 
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如 果 两 个 相 邻 关节 的 z 轴 是 相交 的 ， 那么 它们 之 间 就 没有 公 垂 线 (或 者 说 公 垂 线 距 离 为 零 )， 
这 时 可 将 垂直 于 两 条 轴线 构成 的 平面 的 直线 定义 为 轴 。 也 就 是 说 ， 其 公 垂 线 是 垂直 于 包含 
了 两 条 z 轴 的 平面 的 直线 ， 它 也 相当 于 选取 两 条 z 轴 的 又 积 方向 作为 x 轴 。 
4) y 轴 按 右手 螺旋 法 则 确定 。 
现 将 连 杆 参数 与 坐标 系 的 建立 归纳 为 表 4-1。 
表 4-1 连 杆 参数 及 坐标 系 


连 杆 i 的 参数 



































































































































符号 | 名 称 含义 正 负 号 人 性 质 
转角 “| «1 轴 绕 , 轴 转 至 与 <, 轴 平行 时 的 转角 ”上 胺 右手 法 则 确定 | 全 关 下 为 变量 ,移动 关 闻 为 
里 
, 由 高 | 策 滞 3 方向 移动 至 与 台币 交 了 发 | 与 ,下 向 一 | ”转动 关节 为 常 最 ,移动 关节 为 
9 | 生 的 位 移 致 为 正 | 变量 
| 轴 沿 加 方向 移动 至 与 加 相交 时 移动 | 与 避让 向 一 ee 
l 长 度 er 少量 
的 距离 致 为 正 
a 握 角 | ” 连 杆 7 两 关节 轴线 之 间 的 所 角 搂 右 手法 则 确定 常量 
连 杆 i 的 谷 标 系 Oixiyiz 
原点 0; 坐标 轴 z， 坐标 轴 x; 坐标 轴 yi 
位 于 连 杆 ; 两 关节 得 组 之 人 沿 连 杆 1 两 关节 轴线 的 ee 
生 线 与 关节 i+1 轴线 的 交点 处 。 与 关节 六 1 的 轴线 重合 | 公 重 线 ,并 指向 计 1 关节 A de 

















4. 1.2 连 杆 坐标 系 间 变换 和 矩阵 的 确定 


下 面 来 完成 几 个 必要 的 运动 ， 将 一 个 参考 坐标 系 变换 到 下 一 个 参考 坐标 系 。 假 设 ， 现 在 
位 于 本 地 坐标 系 (x%,,-z,) ， 那 么 通过 以 下 四 步 可 到 达 下 一 个 本 地 坐标 系 (x%,,1 -zi41)。 

1) 绕 z, 轴 旋 转 0,, 角 ( 见 图 4-1a、b)， 使 得 x, 和 xy, 互相 平行 。 因 为 a, 和 cl 都 是 
垂直 于 zx, 轴 的 ， 因 此 绕 z, 轴 旋 转 0,,1 使 它们 平行 (并且 共 面 )。 

2) 沿 z, 轴 平 移 dd, 距离 ， 使 得 x, 和 xi 共 线 ( 见 图 4-1c) 。 因 为 x 和 xi 已 经 平行 并 
且 垂 直 于 zx, ， 治 着 az 移动 则 可 使 它们 互相 重 车 在 一 起 。 

3) 沿 *, 轴 平 移 ,距离 ， 使 得 x 和 wx, 的 原点 重合 ( 见 图 4-14、e)。 这 使 得 两 个 参 
考 坐标 系 的 原点 处 在 同一 位 置 。 

4) 将 z 轴 绕 ,1 轴 旋转 a, ， 使 得 z,,| 轴 与 z,, 轴 在 同一 直线 上 ( 见 图 4-1f) 。 这 时 坐 
标 系 |n} 和 |n+1} 完全 重合 ( 见 图 4-1g) 。 
通过 上 述 变 换 步 骤 ， 可 以 得 到 总 变换 矩阵 4A,,1。 由 于 所 有 的 变换 都 是 相对 于 当前 坐标 
系 的 ( 即 它们 都 是 相对 于 当前 的 本 地 坐标 系 来 测量 与 执行 )， 因 此 所 有 的 矩阵 都 是 右 乘 (或 
者 称 为 顺 乘 ) 。 从 而 得 到 齐 次 变换 矩阵 为 

"7 了 =41=Rot(z,0)xTran(0,0,d ii)xTran(aw ,0,0)xRot(x,a,,) 














ci -sO 0 0lf1 0 0 0100alll 0 0 0 
_ sO co 0 0I10 1 0 0 0 10 0 0 ear -sa 0 td 

0 0 10|I001 dullo 0 1 0 |0 so com 0 

0 0 0 1I[0 00 11l000 1J]lo 0 0 1 
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cOnt1 sOniconrl SOnrsSQntl QnricOntl 
二 SO Oscar COnrisQntl QntisOnti (4-2) 
0 SQn+1 CQOn+1 dl 
0 0 0 1 
例如 ,一般 机 器 人 的 关节 2 与 关节 3 之 间 的 变换 可 以 简化 为 
cOs -sO3ca3 -sO03sQ@3 aac03 
27, -4 - s03 cb03ca3 一 c03sQa3 a3s03 (4.3) 
0 SQ3 CQ3 ds 
0 0 0 1 
对 于 nn 自由 度 机 器 人 来 说 ， 机 器 人 手 部 坐标 系 相对 于 固定 坐标 系 的 变换 矩阵 可 表示 为 
RT =*T TT" T, =A1A,A…A, (4-4) 


对 于 一 个 具有 六 个 自由 度 的 机 器 人 而 言 ，n=6; 式 (4-4) 中 ,及 为 手 部 坐标 系 ，R 为 
固定 坐标 系 。 

例 4-1 图 4-2 所 示 为 具有 六 个 自由 度 的 简单 链 式 机 器 人 。 根 据 “D-H” 表 示 法 ， 建 立 
必要 的 坐标 系 ， 并 填写 相应 的 参数 表 。 


2 
人 


图 4-2 具有 六 个 自由 度 的 简单 链 式 机 器 人 





























解 : 假设 关节 2、3 和 4 在 同一 平面 内 ， 即 它们 的 dd, 值 为 0。 为 建立 机 器 人 的 坐标 系 ， 
寻找 关节 ( 见 图 4-2)。 该 机 器 人 有 六 个 自由 度 ， 在 这 个 机 器 人 中 ， 所 有 的 关节 都 是 旋转 的 。 
首先 ， 对 每 个 关节 建立 z 轴 ， 接 着 建立 x 轴 。 建 立 的 每 个 坐标 系 如 图 4-3 和 图 4-4 所 示 。 

















图 4-3 六 自由 度 链 式 机 器 人 的 参考 坐标 系 





从 关节 工 开始 ， 设 za 沿 第 一 个 关节 的 轴线 ， 并 选择 x 与 参考 坐标 系 的 轴 平 行 ， 这 样 
做 仅仅 是 为 了 方便 ，xo 是 一 个 固定 的 坐标 轴 ， 表 示 机 咒 人 的 基 座 ， 它 是 不 动 的 。 第 一 个 关 
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图 4-4 六 自由 度 链 式 机 器 人 的 参考 坐标 系 线 图 

















节 的 运动 是 围绕 着 zo-xo 轴 进 行 的 ， 但 这 两 个 轴 并 不 运动 。 接 下 来 ， 在 关节 2 处 设 定 zz ， 
为 坐标 轴 zo。 和 zi 是 相交 的 ， 所 以 x| 垂直 于 zo 和 zz 。ws 在 zi 和 z, 之 间 的 公 重 线 方向 上 ，xs3 
在 z, 和 zz 之 间 的 公 垂 线 方向 上 ， 类 似 地 ,xs 在 z3 和 纪 之 间 的 公 重 线 方向 上 。 最 后 ，z 和 
z6 是 平行 且 共 线 的 。zs 表示 关节 6 的 运动 ， 而 zo 表示 末端 执行 器 的 运动 。 通 党 在 运动 方程 
中 不 包含 未 端 执行 器 ， 但 应 包含 末端 执行 器 的 坐标 系 ， 这 是 因为 它 可 以 允许 进行 从 坐标 系 
zs-xs 出 发 的 变换 。 同 时 也 要 注意 第 一 个 和 最 后 一 个 坐标 系 的 原点 的 位 置 ， 它 们 将 决定 机 器 
人 的 总 变换 方程 。 可 以 在 第 一 个 和 最 后 一 个 坐标 系 之 间 建 立 其 他 的 (或 不 同 的 ) 中 间 坐 标 
系 ， 但 只 要 第 一 个 和 最 后 一 个 坐标 系 没有 改变 ， 机 器 人 的 总 变换 便 是 不 变 的。 应 注意 的 是 ， 
第 一 个 关节 的 原点 并 不 在 关节 的 实际 位 置 ， 但 证 明 这 样 做 是 没有 问题 的 ， 因 为 无 论 实 际 关节 
是 高 一 点 还 是 低 一 点 ， 机 器 人 的 运动 并 不 会 有 任何 差异 。 因 此 ， 考 虑 原点 位 置 时 可 不 用 考虑 
基 座 上 关节 的 实际 位 置 。 

接 下 来 ， 将 根据 已 建立 的 坐标 系 来 填写 表 4-2 中 的 参数 。 参 考 前 一 节 中 任意 两 个 坐标 系 
之 间 的 四 个 运动 的 顺序 。 从 zo-xo 开始 ， 有 一 个 旋转 运动 将 xo 转 到 了 x, ， 为 使 得 xo 与 x; 轴 
合 ， 需 要 沿 z| 和 沿 x| 的 平移 均 为 零 ， 还 需要 一 个 旋转 将 zo 转 到 z, ， 注 意 旋转 是 根据 右手 
规则 进行 的 ， 即 将 右手 手指 按 旋转 的 方向 弯曲 ， 大 拇指 的 方向 则 为 旋转 坐标 轴 的 方向 。 到 了 
此 时 ，zo-xo 就 变换 到 了 zx -xi 。 

接 下 来 , 绕 z 旋转 0,， 将 x| 转 到 了 x,， 然 后 沿 x, 轴 移 动 距离 a, ， 使 坐标 系 原 点 重合 。 
由 于 前 后 两 个 z 轴 是 平行 的 ， 所 以 没有 必要 绕 x 轴 旋 转 。 按 照 这 样 的 步骤 继续 做 下 去 ， 就 能 
得 到 所 需要 的 结果 。 














表 4-2 机 器 人 各 连 杆 的 “D-H” 参 数 















































杆 件 号 关节 转角 0 距离 d 杆 长 a 扭 角 a 
1 0 0 0 90° 
2 0 0 Q2 0° 
3 03 0 a3 0° 
4 中 0 加 -90° 
5 0s 0 90° 
6 06 0 0 0° 

















0 表示 旋转 关节 的 关节 变量 ，d 表示 滑动 关节 的 关节 变量 。 因 为 这 个 机 器 人 的 关节 全 是 
旋转 的 ， 因 此 所 有 关节 变量 都 是 关节 转角 0。 通 过 从 参数 表 4-2 中 选取 参数 代入 4 矩阵， 便 
可 写 出 每 两 个 相 邻 关 节 之 间 的 变换 矩阵 。 
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为 机 器 人 的 每 一 个 连 杆 建立 坐标 系 ， 并 用 齐 次 变换 来 描述 这 些 坐 标 系 间 的 相对 关系 
(也 称 为 相对 位 姿 ) 。 把 摘 述 一 个 关节 坐标 系 与 下 一 个 关节 坐标 系 间 相对 关系 的 齐 次 变换 矩 
阵 记 作 4 变换 矩阵 〈 或 4 和 抢 阵 ) 。 


4.2 机 带 人 运动 学 方程 的 分 析 


假设 有 一 个 构 型 已 知 的 机 器 人 ， 已 知 连 杆 几何 参数 和 关节 角 矢 量 ， 求 机 器 人 末端 执行 器 
相对 于 参考 坐标 系 的 位 姿 ， 这 称 为 机 器 人 正 向 运动 学 分 析 。 正 向 运动 学 主要 解决 机 器 人 运动 
学 方程 的 建立 及 手 部 位 姿 求解 问题 。 然 而 ， 如 果 想 要 将 机 器 人 的 手 放 在 一 个 期 望 的 位 姿 ， 就 
必须 知道 机 器 人 的 每 一 个 连 杆 的 几何 参数 和 关节 角 矢 量 ， 才 能 将 手 定位 在 所 期 望 的 位 姿 ， 该 
过 程 分 析 称 为 机 器 人 逆向 运动 学 分 析 。 实 际 上 ， 首 运动 学 方程 尤为 重要 ， 因 为 机 器 人 的 控制 
器 将 用 这 些 方程 来 计算 关节 变量 值 ， 并 以 此 来 控制 机 器 人 手 到 达 期 望 的 位 姿 。 

下 面 首先 推导 机 器 人 的 正 运动 学 方程 ， 然 后 利用 这 些 方程 来 计算 逆 运 动 学 方程 。 

图 4-5 所 示 为 机 器 人 手 的 坐标 系 、 参 考 坐 标 系 以 及 它们 的 相对 位 姿 ， 两 个 坐标 系 之 间 的 
关系 与 机 器 人 的 构 型 有 关 。 为 使 建立 方程 过 程 简化 ， 可 分 别 分 析 位 置 和 姿态 问题 ， 首 先 推导 
出 位 置 方程 ， 然 后 再 推导 出 姿态 方程 ， 再 将 两 者 结合 在 一 起 而 形成 一 组 完整 的 方程 。 最 后 是 
关于 “D-H” 表 示 法 的 应 用 ， 该 方法 可 用 于 对 任何 机 器 人 构 型 建 模 。 

4.2.1 位 置 的 正 逆 运动 学 方程 

机 器 人 的 定位 ， 可 以 通过 相对 于 任何 坐标 系 的 运动 来 实现 。 例 如 ， 基 于 直角 坐标 系 对 空 
间 的 一 个 点 定位 ， 这 意味 着 有 三 个 关于 *，y，z 轴 的 线性 运动 ， 此外， 如 果 用 球 坐标 来 实 
现 ， 就 意味 着 需要 有 一 个 线性 运动 和 两 个 旋转 运动。 常见 的 情况 有 : 笛 卡 儿 (人 台 架 、 直 角 ) 
坐标 、 圆 柱 坐 标 、 球 坐标 、 链 式 (拟人 或 全 旋转 ) 坐标 等 。 下 面 以 直角 坐标 机 器 人 和 球 坐 
标 机 器 人 为 例 进 行 位 置 运动 学 分 析 。 

(1) 直角 坐标 机 器 人 运动 学 分 析 “这 种 情况 下 有 三 个 沿 *x，y，z 轴 的 线性 运动 ， 这 一 类 
型 的 机 器 人 所 有 的 驱动 机 构 都 是 线性 的 〈 如 液压 活塞 或 线性 动力 丝 杠 ) ， 这 时 机 器 人 手 的 定 
位 是 通过 三 个 线性 关节 分 别 沿 三 个 轴 的 运动 来 完成 的 ， 如 图 4-6 所 示 。 台 架 式 机 器 人 基本 上 
就 是 一 个 直角 坐标 机 器 人 ， 只 不 过 是 将 机 器 人 固 连 在 一 个 朝 下 的 直角 架 上 。 
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图 4-5 机 器 人 的 手 坐 标 系 及 参考 坐标 系 图 4-6 直角 坐标 机 器 人 
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当然 ， 如 果 没 有 旋转 运动 ， 表 示 向 P 了 点 运动 的 变换 和 矩阵 是 一 种 简单 的 平移 变换 和 矩阵， 
下 面 将 可 以 看 到 这 一 点 。 注 意 这 里 只 涉及 坐标 系 原点 的 定位 ， 而 不 涉及 姿态 。 在 直角 坐标 系 
中 ， 表 示 机 器 人 手 位 置 的 正 运动 学 变换 矩阵 为 





[sa 


RT = 了 (4-5) 


1 0 
0 0 
eat 0 1 


OO 一 


也。 
P, 
P, 
000 1 
其 中 ,Tb 是 手 坐 标 系 原点 了 相对 于 参考 坐标 系 的 变换 矩阵 ，T, 表 示 直 角 坐 标的 变换 
矩阵。 对 于 逆 运 动 学 的 求解 ， 只 需 简单 地 设 定期 望 的 位 置 等 于 己 。 


例 4-2 要 求 笛 卡 儿 坐 标 机 器 人 手 坐 标 系 原点 定位 在 点 P= [3 4 7] ,计算 所 需要 的 
笛 卡 儿 坐 标 运 动 。 











解 : 设 定 正 运动 学 方程 用 式 (4-5) 中 的 47， 和 矩阵 表示 ， 根 据 期 望 的 位 置 可 知 
1 0 0 PP, 1 00 3 
0 1 0 P 0 1 0 4 
7 全 医 或 P,=3,P,=4,P,=7 
”oo01Pl 0017 * ?7 
0 0 0 1 0 0 0 1 


(2) 球 坐 标 机 器 人 运动 学 分 析 ”如 图 4-7 所 示 ， 球 坐标 系 由 一 个 线性 运动 和 两 个 旋 
转运 动 组 成 ， 运 动 顺序 为 ， 先 沿 z 轴 平移 >， 再 绕 y 轴 旋 转 6， 并 绕 z 轴 旋 转 y。 这 三 个 
变换 建立 了 手 坐 标 系 与 参考 坐标 系 之 间 的 联系 。 由 于 这 些 变换 都 是 相对 于 全 局 参考 坐 
标 系 的 坐标 轴 的 ， 因 此 由 这 三 个 变换 所 产生 的 总 变换 矩阵 可 以 通过 依次 左 乘 每 一 个 变 
换 和 矩阵 而 求 得 














图 4-7 球 坐 标 机 带 人 








“> =T ,i(7,B,Y)= Rot(z,y) Rot(y,B)Trans(0,0,Yy) 


cy -sy 0 0|I|Iw 0 BB 0Il1 0 0 0 
sy oy 00lo 1 0 0l0100 
“jo 0 1 0|-#8 0 8 0l00 1 
0 0 01||0 oo 1|l0001 
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ccy -sy scy rsBey 
Bsy cy sBsy rsy (4.6) 
-sB 0 obB roB 
0 0 0 1 
式 (4-6) 中 前 三 列 ， 表 示 了 经 过 一 系列 变换 后 的 手 坐 标 系 的 姿态 ， 而 最 后 一 列 则 表示 
了 手 坐 标 系 原 点 的 位 置 。 
球 坐 标的 逆 运 动 学 方程 比 简单 的 直角 坐标 和 圆柱 坐标 更 复杂 ， 因 为 两 个 角度 6 和 7 是 耦 
合 的 。 下 面 通 过 例题 来 说 明 如 何 求解 球 坐 标 机 器 人 的 道 运动 学 方程 。 
例 4-3 假设 要 将 球 坐 标 机 器 人 手 坐 标 系 原点 放 在 [3 4 7]"， 计算 该 机 器 人 的 各 关节 变 
量 值 。 
解 : 根据 式 (4-6) 的 了 








矩阵， 将 手 坐 标 系 原点 的 位 置 分 量 设置 为 期 望 值 ， 可 以 得 到 


ph 


rsgcy =3 (a) 
rsBsy =4 (b) 
rcB=7 (c) 


由 式 (ec) 可 以 得 出 8 是 正 数 ,但 没有 关于 8 是 正 或 负 的 信息 。 将 式 (a) 式 和 式 
(b) 两 个 方程 彼此 相 除 。 因 为 不 知道 #8 的 实际 符号 是 什么 ， 因 此 可 能 会 有 两 个 解 。 下 面 的 
方法 给 出 了 两 个 可 能 的 解 ， 后 面 还 必须 对 这 最 后 的 结果 进行 检验 ， 以 确保 它们 是 正确 的 。 


4 
Wiy Sy 53. 1° 或 233.1° 





sy=0.8 或 -0.8 
cy=0.6 或 -0.6 

3 、3 
"B= 6=5 或 -0 6-5 
rog=7 B=35.5° 或 -35. 5? 
r=8.6 


可 以 对 这 两 组 解 进行 检验 ， 并 证 实 这 两 组 解 都 能 满足 所 有 的 位 置 方 程 。 如 果 沿 给 定 的 三 
维 坐标 轴 旋 转 这 些 角 度 ， 物 理 上 的 确 能 到 达 同 一 点 。 然 而 必须 注意 ， 其 中 只 有 一 组 解 能 满足 
姿态 方程 。 换 句 话 说 ， 前 两 种 解 将 产生 同样 的 位 置 ， 但 会 处 于 不 同 的 姿态 。 由 于 目前 并 不 关 
心 手 坐 标 系 在 这 点 的 姿态 ， 因 此 两 个 位 置 解 都 是 正确 的 。 实 际 上 ， 由 于 不 能 对 三 自由 度 的 机 
器 人 指定 姿态 ， 所 以 无 法 确定 两 个 解 中 哪 一 个 解 和 特定 的 姿态 有 关 。 


4.2.2 机 器 人 姿态 的 正 逆 运动 学 方程 


假设 固 连 在 机 器 人 手 上 的 运动 坐标 系 已 经 运动 到 期 望 的 位 置 上 ， 但 它 仍然 平行 于 参考 举 
标 系 ， 或 者 假设 其 姿态 并 不 是 所 期 望 的 ， 下 一 步 是 要 在 不 改变 位 置 的 情况 下 ， 适 当地 旋转 坐 
标 系 而 使 其 达到 所 期 望 的 姿态 。 合 适 的 旋转 顺序 取决 于 机 器 人 手腕 的 设计 以 及 关节 装配 在 一 
起 的 方式 。 考 虑 以 下 三 种 常见 的 构 型 配置 : 中 滚动 角 、 俯 仰角 和 偏 航 角 ; @ 欧 拉 角 ; @) 链 式 
关节 (后面 在 讨论 D-H 表示 法 时 将 推导 链 式 坐标 的 矩阵 表示 法 ) 。 

(1) 用 滚动 角 、 俯 仰角 和 偏 航 角 表示 运动 姿态 ”假定 当前 的 坐标 系 平行 于 参考 坐标 系 ， 
于 是 机 器 人 手 的 姿态 在 RPY [滚动 角 (roll) 、 俯 仰角 (pitch)、 偏 航 角 (yaw)] 运动 前 与 
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参考 坐标 系 相 同 。 分 别 绕 当前 a，o，n 轴 的 三 个 旋转 顺序 ， 能 够 把 机 器 人 的 手 调整 到 所 期 望 
的 姿态 〈 图 4-8) 。 如 果 当 前 坐标 系 不 平行 于 参考 坐标 系 ， 那 么 机 器 人 手 最终 的 姿态 将 会 是 
先前 的 姿态 与 RPY 右 乘 的 结果 。RPY 的 旋转 运动 都 是 相对 于 当前 的 运动 轴 的 ， 右 乘 所 有 由 
RPY 和 其 他 旋转 所 产生 的 与 姿态 改变 有 关 的 矩阵 ， 就 可 得 到 所 期 望 的 姿态 (图 4-9)。 












































旋转 $4 旋转 加 旋转 办 
图 4-9 绕 当 前 坐标 轴 的 RPY 旋转 





参考 图 4-9， 可 看 到 RPY 旋转 包括 以 下 几 种 : 
1) 绕 a 轴 (运动 坐标 系 的 z 轴 ) 旋转 由 称 为 滚动 ( 横 滚 ) 。 
2) 绕 o 轴 (运动 坐标 系 的 y 轴 ) 旋转 由 。 称 为 傅 仰 。 
3) 绕 n 轴 (运动 坐标 系 的 x 轴 ) 旋转 由 称 为 偏 航 〈 偏 转 ) 。 
表示 RPY 姿态 变化 的 矩阵 为 
RPY(9, ,9,,9,)= Rot(a,gb,)Rot(o,g,)Rot(n,g,) 
co。 cs 四 os 四-s 由 uc， cs 由 cd ts 四 es， 0 





_ shuch, shusp,sgb, tech ch, sbish cb, -cb ss， 0 (47) 
-sp, cs cc 0 
0 0 0 1 


这 个 矩阵 表示 了 仅 由 RPY 引起 的 姿态 变化 。 该 坐标 系 相对 于 参考 坐标 系 的 位 置 和 最 终 
姿态 是 表示 位 置 变化 和 RPY 的 两 个 矩阵 的 乘积 。 例 如 ， 假 设 一 个 机 器 人 是 根据 球 坐 标 和 
RPY 来 设计 的 ， 那 么 这 个 机 器 人 就 可 以 表示 为 
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&T7r=Tsn(r;B,y)xRPY(C 和 中 中) (4-8) 
关于 RPY 的 逆向 运动 学 方程 的 求解 比 球 坐 标 更 复杂 ， 因 为 这 里 有 三 个 耦合 角 ， 所 以 需 
要 所 有 三 个 角 各 自 的 正弦 和 余弦 值 的 信息 才能 解 出 这 个 角 。 为 解 出 这 三 个 角 的 正弦 值 和 余弦 
值 ， 必 须 将 这 些 角 解 耘 。 因 此 ,用 了 Rot(c， 由 ) 的 逆 左 乘 式 (4-7) 两 边 , 得 
Rot(a,$,)  RPY( 由 ,由 ,由 )= Rot(o,g,),Rot(n,g,) 
假设 用 RPY 得 到 的 最 后 所 期 望 的 姿态 是 用 (n，o。，a) 和 矩阵 来 表示 的 ， 则 有 














jn of 0 0 

Rot(Cc ,小 ) = 了 ot(o ,小 ) ,Rot(7 ,中 ) 
We “We 0 
0 0 0 1 


进行 矩阵 相 乘 后 得 

ncbatnysp, owcbatoysb, acbatays$, 0 

nycb, -nsg, ocPa 0sb, ayc$ ,asb, 0 
Bl 
1 


| 0 0 0 
| cb, spbsh, sp,ch, 0 
0 cp, -sp, 0 
-spb, ch,shb, ch,ch, 0 
| 0 0 0 1 
使 式 (4-9) 左右 两 边 对 应 的 元 素 相 等 ， 将 产生 如 下 结 
根据 元 素 (2，1) 得 
nycb a-n.spa =0—49, =atan2( ny ,ny ) 或 小 =atan2( 3 —n, ) (4-10) 
( 注 : 用 双 变 量 反 正切 函数 确定 角度 在 求解 时 ， 总 是 采用 双 迹 
变量 反正 切 函 数 atan2 来 确定 角度 。atan2 提供 两 个 自 变 量 ， 即 纵 xy | xy 
坐标 和 横 坐 标 ， 如 图 4-10 所 示 。 当 -m0<m， 由 atan2 反 求 角 
度 时 ， 同 时 检查 y 和 ww 的 符号 来 确定 其 所 在 象限 。 这 一 函数 也 能 0 
检验 什么 时 候 x 或 y 为 0， 并 反 求 出 正确 的 角度 。atan2 的 精确 程 nl 
度 对 其 整个 定义 域 都 是 一 样 的 。) ns 
根据 元 素 (3，1) 和 元 素 (1, 1) 得 
| =n 


二 = 
cp, = mc。 +tnysg, 


(4-9) 























5 





中 ,=atan2| —n,, (nichatn,sg, ) ] 图 4-10 反正 切 函 数 atan2 


(4-11) 
根据 元 素 (2，2) 和 元 素 (2，3) 得 
ch, =oyc 和 -oss。 
下 =-aych, taysg, 
例 4-4 下 面 给 出 了 一 个 笛 卡 儿 坐 标 一 RPY 型 机 器 人 手 所 期 望 的 最 终 位 姿 ， 求 滚动 角 、 
俯仰 角 、 偏 航 角 和 位 移 。 
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一 路 =atan2[ ( -aycba tassg, ) , (ocba -ossg, ) 中 (4-12) 
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mx Or Qx Px 0.354 -0.674 0.649 4.33 


Ne mr or a, py| | 0.505 0. 
Bs n, 0, Qa, Pp; |-0.788 0. 
0 0 0 1 0 


解 : 根据 上 述 方程 ， 得 到 两 组 解 





722 
160 
0 


0.475 2.50 
0.595 8 
0 1 


中 , =atan2( n, ,n, )= atan2(0. 505,0. 354)= 55° 或 235° 
中 ,=atan2| -n,,( ncba tn,sg, ) ] =atan2(0.788 ,0. 616)= 52° 或 128° 
中 ，=atan2|[ ( -aych, tassh, ) , (0ycPa -os ) ] 


=atan2(0. 259,0.966)= 15° 或 195° 


px =4.33 py=2.50 


例 4-5 与 例 4-4 中 的 位 姿 一 样 ， 如 果 机 器 人 是 圆柱 坐标 一 RPY 型 ， 求 所 有 关节 变量 。 


解 : 在 这 种 情况 下 ， 可 用 


ps=8 


0.354 -0.674 0.649 4.33 
| 0.505 0.722 0.475 2.50 
? |-0.788 0.160 0.595 
0 0 0 
=T(r,0,l) XRPY (9, ,9, ,9,) 


R 


这 个 方程 右边 有 4 个 角 ， 它 们 是 耦合 的 ， 因 此 必 
须 像 前 面 那样 将 它们 解 簿 。 但 是 ， 因 为 对 于 圆柱 坐标 
系 z 轴 旋转 由 角 并 不 影响 a 轴 ， 所 以 它 仍 平行 于 = 
轴 。 其 结果 是 ， 对 于 RPY 绕 a 轴 旋 转 的 a 角 可 简单 
地 加 到 $。 上。 这 意味 着 ， 求 出 的 。 实际 上 是 ($+ 
a) ( 见 图 4-11)。 圆 柱 型 坐标 系 包 括 两 个 线性 平移 运 
动 和 一 个 旋转 运动 。 其 顺序 为 : 先 沿 x 轴 移 动 >， 再 
绕 z 轴 旋转 a 角 ， 最 后 沿 z 轴 移 动 1， 这 三 个 变换 建立 
了 机 器 人 坐标 系 与 参考 坐标 系 之 间 的 联系 。 由 于 这 些 
变换 都 是 相对 于 全 局 参考 坐标 系 的 坐标 轴 的 ， 因 此 由 
这 三 个 变换 所 产生 的 总 变换 可 以 通过 依次 左 乘 每 一 个 
和 矩阵 而 求 得 : 











8 
1 


四 | 








图 4-11 





圆 村 


x 


E 和 RPY 坐标 





*T, =T (7, 0,l)= Trans(0,0,l) Rot(z,a)Trans(r,0,0) 


1] 0 0 0llcae -sa 0 0 


0 10 0llsg ce 0 0 
“Io01 0 0 10 
0 0 0 0 0 01 
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RQ 
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机 
RQ 


1 


em 


0 


> 


Le 


一 OO OR 


(4-13) 
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参考 式 (4.6) 可 得 
rca=4.33 
rsa=2. 50—a=30° 
路 ,+a=535?" 一 小 =25° 
SQ=0.3 一 7=9 
D-=8 一 /=8 
与 例 4-4 一 样 一 由 ,=52” ,=15° 
当然 ,可 以 用 类 似 的 解法 求 出 第 二 组 解 。 
(2) 用 欧 拉 角 表 示 运 动 姿态 ”除了 最 后 的 旋转 仍然 是 对 当前 的 a 轴 外 , 欧 拉 角 的 其 他 方 
面 均 与 RPY 相似 ( 见 图 4-12)。 仍 需要 使 所 有 旋转 都 是 绕 当 前 的 轴 转 动 以 防止 机 右 人 的 位 置 
有 任何 改变 。 表 示 欧 拉 角 的 转动 如 下 : 
1) 绕 a 轴 ( 运 动 坐 标 系 的 z 轴 ) 旋 转 由 。 
2) 接 着 绕 新 o 轴 ( 运 动 坐标 系 的 y 轴 ) 旋 转 0。 
3) 最 后 再 绕 新 a 轴 ( 运动 坐标 系 的 z 轴 ) 旋 转 风 。 
表示 欧 拉 角 姿态 变化 的 矩阵 是 
Euler(4$,0,y)= Rot(a,g$) Rot(o,0),Rot(a,y) 
cqhcOcy -shey -cqcOsy -sbcy cs 0 
_ | scgcy+cdsW -sbcOsytcbey shs0 0 
0 
1 








—sOcy sOsy co Be 


0 0 0 





图 4-12 绕 当前 坐标 轴 的 欧 拉 旋转 


再 次 强调 ， 该 矩阵 只 是 表示 了 由 欧 拉 角 所 引起 的 姿态 变化 。 相 对 于 参考 坐标 系 ， 这 个 坐 
标 系 的 最 终 位 姿 是 表示 位 置 变化 的 矩阵 和 表示 欧 拉 角 的 矩阵 的 乘积 。 

欧 拉 角 的 逆向 运动 学 求解 与 RPY 非常 相似 。 可 以 使 欧 拉 方程 的 两 边 左 乘 Rot™' (a,， 中) 
来 消去 其 中 一 边 的 由 。 让 两 边 的 对 应 元 素 相等 ， 就 可 得 到 以 下 方程 【假设 由 欧 拉 角 得 到 的 最 
终 所 期 望 的 姿态 是 由 (n，o，a) 和 矩阵 表示 ] 














cOcJ -cOsy 50 


0 0 
n, 0o, a, 0 4 0 0 
Rotrl(a ,bx| ” 2? lB 全 (4-15) 
0 -Soc so co 0 
1 1 


0 0 0 
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mxc+7s ocbtoysb a.cbtaysb 0 cgcy -cbsyy s0 0 
-nsptncb -owsptoycb -aisptaycp 0 | sw cy 0 
0| -sOcy so co 0 
0 0 0 1 0 0 0 1 
式 (4-15) 中 的 n,，o，, a 表示 了 最 终 的 期 望 值 ， 它 们 通常 是 给 定 或 已 知 的 。 欧 拉 角 的 
值 是 未 知 变量 。 
使 式 (4-16) 左右 两 边 对 应 的 元 素 相等 ， 可 得 到 如 下 结果 . 
根据 元 素 (2，3) ， 可 得 
aspb+taycb=0— $=atan2 (a, ,au) 或 =atan2( -ay ,一 ax ) (4-17) 
由 于 求 得 了 中 值 ， 因 此 式 (4-15) 左边 所 有 的 元 素 都 是 已 知 的 。 根 据 元 素 (2, 1) 和 
元 素 (2, 2) 得 


(4-16) 


n 0; a, 




















SV=—n,sD+n,c 
| V 5 7 es (4-18) 


=-0ssbtoych 
最 后 根据 元 素 (1，3) 和 元 素 (3, 3) 得 
s0=a.ch+a,sg 
| pa ~ 0=atan2(achbta,sg ,a,) (4-19) 
直角 坐标 系 - 欧 拉 角 型 机 器 人 手 的 最 终 期 望 位 姿 ， 求 相应 的 欧 拉 角 。 


Ny Ox Ux Px 0. S79 一 0. 548 一 0. 604 5 


例 4-6 给 定 一 个 





Rp ly or oy Py|_|0.540 0.813 -0.220 7 
”mo oa p,| |0.611 -0.199 0.766 3 
0 0 0 1 0 0 0 1 


解 : 根据 前 面 的 方程 ， 得 到 
$=atan2(a, ,a,)= atan2(-0.220,-0.604)= 20° 或 200° 
将 20" 和 200° 的 正弦 值 和 余弦 值 应 用 于 其 他 部 分 ， 可 得 
=atan2( -nisp+tn,cg, -0oxs 册 +oyc 由 ) = atan2(0.31,0.952)= 18° 或 198。 
0=atan2( asch+ta,sg ,4,)= atan2( -0.643,0.766)= -40? 或 40 
4.2.3 位 姿 的 正 逆 运动 学 方程 
表示 机 器 人 最 终 位 姿 的 矩阵 是 前 面 章节 所 介绍 几 种 方程 的 组 合 ， 该 矩阵 取决 于 所 用 的 坐 
标 。 假 设 机 器 人 的 运动 是 由 直角 坐标 和 RPY 的 组 合 关节 组 成 ， 那 么 该 坐标 系 相 对 于 参考 坐 
标 系 的 最 终 位 姿 是 表示 直角 坐标 位 置 变化 的 矩阵 和 RPY 矩阵 的 乘积 。 它 可 表示 为 
Ty=Ton( P,P,,P,) XRPY( 9, ,4, ,4,) (4-20) 
如 果 机 器 人 是 采用 球 坐 标定 位 、 欧 拉 角 定 姿 的 方式 所 设计 的 ， 那 么 将 得 到 下 列 方程 。 其 
中 位 置 由 球 坐 标 决定 ， 而 最 终 姿 态 既 受 球 坐标 角度 的 影响 也 受 欧 拉 角 的 影响 。 
RT =T,, (7,B,y) xEuler($,0,w) (4-21) 
由 于 有 多 种 不 同 的 组 合 ， 所 以 这 种 情况 下 的 正道 运动 学 解 不 在 这 里 讨论 。 对 于 复杂 的 设 
计 ， 推荐 用 D-H 表示 法 来 求解 。 
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4.2.4 机 器 人 正 运动 学 方程 的 D-H 表示 法 
仍 以 例 4-1 为 例 来 求解 该 机 器 人 运动 学 方程 ， 所 建立 的 各 关节 坐标 系 如 图 4-3 所 示 ， 各 




















连 杆 参数 见 表 4-2， 则 在 坐标 系 10| 和 {1| 之 间 的 变换 矩阵 4, 可 通过 将 a (sin90。= 1， 
cos90°=0，a=90°) 以 及 指定 0) 等 代入 得 到 ， 对 其 他 关节 的 4,~4。 和 矩阵 也 是 这 样 ， 最 后 得 
co 0 s0 0 | cg -s0, 0 ca, 
i s01 0 -c0 0 二 s0, c0, 0 5S0a， 
0 1 0 0 0 0 1 0 
0 0 0 1 L0 0 0 1 
c0 -s03 0 cOsas | cO4 —s04 cOsas 
汪汪 sc0 0 5003 未 二 SO04 c04 SO04a4 
0 0 1 0 0 -1 0 0 
0 0 0 1 0 0 0 1 
c0s 0 sg 0 c056 -s0 0 0 
0 0 -co 0 0 0 G06 0 
| oo el WE (4-22) 
0 1 0 0 0 0 1 0 
0 0 0 1 L0 0 0 1 
特别 注意 : 为 简化 最 后 的 解 ， 将 用 到 下 列 三 角 函 数 关系 式 
s0ic0, +c01s0, =s(0,+0,)=s 
1C02 tcV1 SU 1102 12 (4-23) 


cO1c0,—s01s0, =c(01+0, )= cl 
在 机 器 人 的 基 座 和 手 之 间 的 总 变换 为 
AT7=414)43444546 (4-24 ) 
该 等 式 称 为 机 器 人 运动 学 方程 。 此 式 右边 表示 从 固定 参考 系 到 手 部 坐标 系 的 各 连 杆 坐标 系 之 
间 的 变换 矩阵 的 连 乘 ， 左 边 *Tj 表示 这 些 变换 矩阵 的 乘积 ， 也 就 是 手 部 坐标 系 相 对 于 固定 参 
考 系 的 位 姿 。 式 (4-24) 计算 结果 为 


R wl a » y 了 入 || 六 
Ty =°T, = = 


nN, 0; 各 Pz 
0 0 0 1 
| ci(cxcsc6 -S2456) C1( Cacsc6 Srce) C1(C2%455 ) ts1C5 ci(craa tcna3tcya, ) 
到 3155C6 AS13536 


5S1(C234C5C6-3234386)】 5S1(-C234C5C6-3234C6)-18586 Si(C2y85) -1C5 Si1(Cxma4tcna3tc2a ) 


TC18S586 
3234C5C6 234C5C6+c23456 323485 3S23404182303 TS202 
0 0 0 1 





式 中 前 三 列表 示 手 部 的 姿态 ， 第 四 列表 示 手 部 的 位 置 。 
例 4-7 已 知 三 自由 度 平面 关节 机 器 人 如 图 4-13 所 示 ， 设 机 器 人 杆 件 1、2、3 的 长 度 为 
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/1 ，1 ，l3。 试 建立 机 右 人 的 运动 学 方程 。 

解 : 1) 建立 坐标 系 。 如 图 4-13 所 示 ， 机 座 坐 标 系 
10} ， 杆 件 坐标 系 1 让 ， 手 部 坐标 系 |m (与 末端 jn 
重合 ) 。 

2) 确定 参数 。 机 器 人 各 连 杆 参数 见 表 4-3。 

则 相 邻 杆 件 位 姿 矩 阵 为 
401 = 了 Rot(z,0 )Trans(1 ,0,0)= 
































cg -0 0 OF1 0 0 1] fe -s0 0 10cb 
01 oO 0 0llo 10 0| |s0 co 0 Ls0, 
0 0 1oloo1lollo 0 1 0 图 4-13 机 器 人 杆 件 坐 标 系 建立 
0 0 0 1000 1 0 0 0 1 
表 4-3 机 器 人 各 连 杆 参数 
: d 0; L a 4 
1 0 Oi L 0 0 
2 0 0, L 0 0, 
3 0 6 ls 0 人 
同 理 可 得 
A, =Rot(z,0,)'Trans(l,,0,0)= A,;=Rot(z,0;)Trans(/;,0,0)= 

[cg， -3s0, 0 Lc cO; -s0; 0 lac0, 

s0, cg， 0 Ls0, s03 cs 0 Ls03 

0 0 1 0 0 0 1 0 

L0 0 0 1 0 0 0 1 
则 机 器 人 的 运动 学 方程 为 





11cO+12c02+L3c0123 
7o =404 12A73(1) 0 


0 

sO123 co13 0 1s0+/2s02+43c0123 
1 
0 1 


4.2.5 机 器 人 的 逆 运 动 学 方程 


道 运 动 学 解决 的 问题 是 : 已 知 手 部 的 位 姿 ， 求 各 个 关节 的 变量 。 为 了 使 机 器 人 手臂 处 于 
期 望 的 位 姿 ， 如 果 有 了 逆 运 动 学 解 就 能 确定 每 个 关节 的 值 。 在 机 需 人 的 控制 中 ， 往 往 已 知 手 
部 到 达 的 目标 位 姿 ， 需 要求 出 关节 变量 以 驱动 各 关节 的 电动 机 ， 使 手 部 的 位 姿 得 到 满足 。 下 
面 将 研究 求解 逆 运 动 方程 的 一 般 步 又 。 

仍 以 例 4-1 中 的 简单 机 械 手臂 为 例 。 虽 然 所 给 出 的 解决 方法 只 针对 这 一 给 定 构 型 的 机 器 
人 人， 但 也 可 以 类 似 地 用 于 其 他 机 器 人 。 机 器 人 的 运动 学 方程 为 
RT, =44)43444.4， 
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3234C5C6 一 3234C5C6+c234C6 323435 


0 0 0 





3234041S2303+S202 


[ci(cxgcsc6 32456) -S18sC6 cl( -zc5C6-23406)H818586 C1(C2455) 481Cs C1(Cxy04tenastc20) 


S1(C234C506-323436) +C1S5S6 SS1( CoCsC6™ S746) C1S5s6 Si(C2455) 1Cs SS1(Cr404tcna3+c24, ) 


为 了 书写 方便 ， 将 上 面 的 矩阵 表示 为 【RHS] (Right-Hand Side) 。 这 里 将 机 器 人 的 期 户 


位 姿 表 示 为 


y 
R 1 三 


为 了 求解 角度 ， 从 4? 开始 ， 依 次 用 A7' 左 乘 上 述 两 个 矩阵 ， 得 到 


UF 0 a Px 


n, 0 a, Py | 
=4jI[RHS] =A,A;AsA,As 


n, 0, Qa, Pp; 


0 0 0 1 
| ci 3S1 0 0 Ne Ox Cr Px 
0 0 1 0| In o a, py 
x| fA,A,AAsA, 
1 Te 0 0| in o0. a. 7. 
0 -0 O01 0 0 0 1 


[ncitn,ysi OxC1 +0,S1 QC1ta)s1 Pxc1+p,s1 
nN, O02 Qz P: 
NASITICY QuxS1-QyC1 Pasi-Ppyc1! Pas1-Pyc1 
0 0 0 1 
| c234c5c6 一 23486 C234C5C6 5234C6 C23455 。C23404 十 C2303 十 C202 
$234C5C6 tC23456 3234C5C6+C234C6 323455 523404+523Q3+5202 
一 55C6 $5556 Cj 0 
上 0 0 0 1 
根据 方程 的 元 素 (3，4) 有 





prs1-pyc1=0 一 0 -arctan 





,=0u+180° 


根据 元 素 (1，4) 和 元 素 (2，4) 可 得 
的 +p,s1 三 C234Q4 十 C23Q3 十 C2Q2 
P:=523404 +52303+5242 
整理 上 面 两 个 方程 并 对 两 边 平方 ， 然 后 将 平方 值 相 加 ， 得 


2 _ 2 
| (Pacl+py31-c23404) = (C2303+c202 ) 





(ps—s23404) = (s2303+s2a2 ) 


76 


(4-25) 


(4-26) 


(4-27) 


(4-28) 
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(prc1tpys1 -C23404) ?+(ps-s23404) =a2+a3+2a203(S2S23+C2C23 ) 
根据 式 (4-23) 的 三 角 函 数 方 程 ， 可 得 
5$2523+c2C23 =cos[ (02+03 ) -0, | =cosb3 
2_ 2 


2 2 
(Pic1+pys1 -C23404) 十 (PS23404 ) 一 02 一 03 
C3 二 





2a203 


在 这 个 方程 中 ， 除 S234 和 cza4 外 » 每 个 变量 都 是 已 知 的 » sz34 和 ca4 将 在 后 面 求 出 o 


已 知 : 
s3 = 十/ 1—c3 
于 是 可 得 
53 
03 =arctan 一 
C3 


(4-29) 


(4-30) 


因为 关节 2、3 和 4 都 是 平行 的 , 左 乘 4; 和 A 和; 的 道 不 会 产生 有 用 的 结果 。 下 一 步 左 乘 


A1~As 的 道 ， 结 果 为 


ot an ed et | wg Oy 27y py tm en Mm | 
Ai!'A3!'As!'AT!x ] =Ai!A3!'A;!'AT'[ RHS] =4,4。 


n, 0, a, Pp; 


(4-31) 


0 0 0 1 
乘 开 后 可 得 
| CaCInitsiny Hspns, cza(closHS10y )Hs2a40。 coa(ClausHS10) )Hoa4d。 coalCIPs ts1Dy)+s2yp; 
“C4402 《403 04 
CU SN C10) “S10% Clay 到 31Q。 0 


0 0 0 1 


CsC6 C556 $5 


56 c6 0 





0 
ssce -sssé -cs 0 
0 
1 


| 0 0 0 
根据 式 (4-32) 中 的 元 素 (3, 3) 有 


—s234 (C14 tS10y) tes340s = 0 





0 =areton| ]m 0)34 =0%34+180° 


C1Qx tS1Qy 


由 此 可 计算 sj 和 cys4， 如 前 面 所 讨论 过 的 ， 它们 可 用 来 计算 0,。 


3402 403 


234(CU HS) tpgns 一 3234(C10xAS10y )+c2340。 -3234(ClQsTS10y )+coa40。 3234(CIDeHSID) )+cz40。 


(4-32) 


(4-33) 


现在 再 参照 式 (4-28) ， 并 在 这 里 重复 使 用 它 就 可 计算 9, 的 正弦 和 余弦 值 。 具 体 步 又 如 下 : 


由 于 C12 三 C1C2? 一 35182 以 及 512 =s1C>+c1s,, 可 得 
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Dascl+DpyS1-C23404 =(c2C3 一 5233 ) 03 十 CQ2 

















(4-34) 
P,-s23404 = (52C3+C253 ) q3 +S202 
上 面 两 个 方程 中 包含 两 个 未 知 数 ,求解 cv 和 s, ， 可 得 
_ (C303 +a2 ) (ps—s23404 ) -S303( Pic1 tpys1 -C404) 
(caa3+a2 ) +s3a3 (4.35) 
_ (C03 +a2 ) (Pucl+DyS1-C23404 ) +s343( Pps-s23404 ) 
( C343 +a, )? +s3a3 
尽管 较 复 杂 ， 但 它 的 所 有 元 素 都 是 已 知 的 ， 因 此 可 以 计算 得 到 
十 一 +D S 一 
〈《c3a3+a2 ) (PS23404) -3303( Pucl Pys1 C23404 ) (4-36) 
《ca3a3+a2 ) (Duecl+PyS1-C23404 ) +s343( Ps -823404 ) 
既然 9, 和 0, 已 知 ， 进 而 可 得 
0, =0,34-0,—03 (4-37) 
因为 式 (4-33) 中 的 34 有 两 个 解 ， 所 以 94 也 有 两 个 解 。 
根据 式 (4-32) 中 的 元 素 (1，3) 和 元 素 (2，3) ， 可 以 得 到 
55 =c234( C1Q， +S10y ) 十 S234Q 
(4-38 ) 
C5 三 一 C10yTS1Qx 
+sia.)+ 
0; =arctan Co ) #900 (4-39) 





S1Qx 一 C1Qy 


因为 对 于 66 没有 解 耦 方程 ， 所 以 必须 用 45 矩阵 的 逆 左 乘 式 (4-32) 来 对 它 解 看 。 这 样 
做 后 可 得 到 








[esl ca cin tsin, ) +s2n, | -ss( siny cin, ) csL cza4(clos+S10y ) +s2340。] -ss( S104 C10, ) 0 0 
234( CIN ts17) ) tcp4n, 8234( C104 +810y ) +C2340。 0 0 
0 0 1 0| 
| 0 0 0 1 
[co -se 0 0 
seé ceo 0 0 (4.40) 
0 0 1 9 
0 0 0 1 





根据 式 (4-40) 中 的 元 素 (2，1) 和 元 素 (2，2) ， 可 以 得 到 
一 3234( Cl TS17y ) +C23471z 
06 =arctan Be ee (4-41) 
至 此 找到 了 6 个 方程 ， 它 们 合 在 一 起 给 出 了 机 器 人 置 于 任何 期 望 位 姿 时 所 需 的 关节 值 。 
虽然 这 种 方法 仪 适用 于 给 定 的 机 器 人 ， 但 也 可 采取 类 似 的 方法 来 处 理 其 他 的 机 器 人 人。 上述 求 
解 的 过 程 称 为 分 离 变量 法 。 即 将 一 个 未 知 数 由 矩阵 方程 的 右边 移 向 左边 ， 使 其 与 其 他 未 知 数 
分 开 ， 解 出 这 个 未 知 数 ， 再 把 下 一 个 未 知 数 移 到 左边 ， 重 复 进 行 ， 直 到 解 出 所 有 未 知 数 。 
值得 注意 的 是 ， 因 为 此 机 器 人 的 最 后 三 个 关节 交 于 一 个 公共 点 才 使 得 这 个 方法 有 可 能 求 
解 ， 否 则 就 不 能 用 这 个 方法 来 求解 ， 而 只 能 直接 求解 算 阵 或 通过 计算 矩阵 的 逆 来 求解 未 知 的 
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量 。 大 多 数 机 器 人 都 有 相交 的 腻 关 节 。 因 此 可 用 此 方法 求解 。 


4.3 ”典型 机 咒 人 运动 学 方程 的 建 并 及 分 析 





4. 3.1 建立 机 器 人 运动 学 方程 的 方法 及 实例 


例 4-8 结合 本 章 所 学 的 知识 进行 四 自由 度 机 器 人 SCARA 的 正 逆 运 动 学 分 析 。 

SCARA 型 机 器 人 的 运动 学 模型 的 建立 ， 包 括 机 器 人 运动 学 方程 的 表示 ， 以 及 运动 学 正 
解 、 道 解 等 ， 这些 是 研究 机 器 人 控制 的 重要 基础 ， 也 是 开放 式 机 带 人 系统 轨迹 规划 的 重要 基 
在 此 采用 D-H 法 。 





础 。 为 了 描述 SCARA 型 机 器 人 各 连 杆 之 间 的 数学 关系 ， 

SCARA 型 机 器 人 操作 臂 可 以 看 作 是 一 个 开 式 
运动 链 。 它 是 由 一 系列 连 杆 通过 转动 或 移动 关节 
串联 而 成 的 。 为 了 研究 操作 臂 各 连 杆 之 间 的 位 移 
关系 ， 可 在 每 个 连 杆 上 固 接 一 个 坐标 系 ， 然 后 描 
述 这 些 坐 标 系 之 间 的 关系 。 

解 : 1，SCARA 机 器 人 坐标 系 建立 

SCARA 型 机 器 人 的 坐标 系 如 图 4-14 所 示 ， 根 
据 D-H 坐标 系 建立 方法 ，SCARA 机 器 人 的 每 个 关 
节 坐 标 系 的 建立 可 参照 以 下 的 三 个 原则 : 

1) z, 轴 沿 着 第 n 个 关节 的 运动 轴 基 上 坐标 系 的 
选择 为 : 当 第 一 关节 变量 为 零 时 ， |0| 坐标 系 与 
11| 坐标 系 重 合 。 

2) x 轴 垂 直 于 zx, 轴 并 指向 离开 z, 轴 的 方向 。 

3) yy 轴 的 方向 按 右手 定 则 确定 。 

2. 构件 参数 的 确定 

SCARA 机 器 人 的 杆 件 参数 见 表 4-4， 相 应 的 连 杆 初始 位 置 及 参数 列 于 表 中 ，0,,、d， 为 关节 
变量 。 根 据 D-H 构件 坐标 系 表 示 法 ,构件 本 身 的 结构 参数 a,_| 、a_| 和 相对 位 置 参 数 d, 、09， 
可 由 以 下 的 方法 确定 ， 

1) 0, 为 绕 z, 轴 ( 按 右手 定 则 ) 由 x,_1 轴 到 x%, 轴 的 关节 角 。 
2) d, 为 沿 z, 轴 ， 将 x,_| 轴 平移 至 x, 轴 的 距离 。 
3) a 1 为 沿 x,_1 轴 ， 从 zz_1 轴 至 z 轴 的 距离 。 




















图 4-14 ”SCARA 型 机 器 人 的 坐标 系 

















4) ai 为 绕 ww -1 轴 ( 按 右手 定 则 ) 由 z,_1 轴 到 zz 轴 的 偏转 角 。 
表 4-4 SCARA 机 器 人 的 杆 件 参数 
杆 件 号 Qa-l Ql1 d, 0 CosQ 1 SinQ 1 
1 0 0 0 0 1 0 
2 ll 0 0 0, 下 0 
3 /> 0 d; 1 0 
4 0 0 0 04 1 0 


3. 变换 矩阵 的 建立 














全 部 的 连 杆 规定 坐标 系 之 后 ， 











就 可 以 按照 下 列 顺序 来 建立 相 邻 两 连 杆 n-1 和 n 之 间 的 
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相对 关系 : 中 绕 ww-1 轴 转 a 1 角 ; 书 沿 x,_1 轴 移动 a,_1; 轩 绕 二 轴 转 0, 角 ; 外 沿 z, 轴 移 
动 d。 
这 种 关系 可 由 表示 连 杆 对 连 杆 n-1 的 相对 位 置 齐 次 变换 矩阵 "7T, 来 表征 。 即 
1 = 了 (xl ) Qn-1 ) T(xn -1 9 Wn-1 ) T(z ,0,) T(z ,dd,) 





2 
展开 上 式 得 
cos0, —sinO, 0 Ql 
5 Sin0 cosa，1 cosO cosa 1 -sina， 1 -d,sing,_i 
Ts | | (4-42) 
Sin0,Sina， 1 cos0,sina, cosa 1 dcosa 1 
0 0 0 1 


由 于 ”7T, 描述 第 n 个 连 杆 相对 于 第 n-1 个 连 杆 的 位 姿 ,对 于 SCARA 机 器 人 (四 个 自 
由 度 ) ， 机 器 人 的 末端 装置 即 为 连 杆 4 的 坐标 系 ， 它 与 基 座 的 关系 为 
了 
如 图 4-14 所 示 坐 标 系 ， 可 写 出 连 杆 n 相对 于 连 杆 n-1 的 变换 矩阵 "7T,: 


er 3 V0 cr- 0 0 1 00 / cy 0 0 
o7, = SS cl 0 0 17, = s» c, 0 0 27,= 0 10 0 37,= s4 Cc 1 0 
0 0 10 0 0 10 001 4 0 0 10 
0 0 01 0 0 0 1 0 .00 1 0 0 01 
4. SCARA 机 器 人 的 正 运动 学 分 析 
各 连 杆 变换 矩阵 相 乘 ， 可 得 到 SCARA 机 器 人 末端 执行 器 的 位 姿 方 程 〈 正 运动 学 方程 ) 为 
Ny On Cx Px 
oT =0T (0 TA(0) TG) TA0)=| 7 = 
4 一 1\01) F202) La3\d3) fa 04)= 一 
总 Oz Cz Pz 
0 0 0 1 
C1C2C4—$18254—C15254 -$1C254 ~C1C2S4+818284—C152S4—S1C2C4 0 cicsls-sissls teli 
S1C2C4 TC1S2C4 S182S4+C1C2S4 ~S1C2S4-C1S254—S182S4+C1C2C4 0 sicslyte1ssls ts1ll 
0 0 1 -da 
0 0 0 0 
(4-43 ) 
该 式 表示 了 SCARA 手臂 变换 矩阵 “74 ， 描 述 了 来 端 连 杆 坐标 系 14} 相对 基 坐 标 系 10| 


的 位 姿 。 
5. SCARA 机 器 人 的 逆 运 动 学 分 析 
1) 求 关节 变量 0 。 为 了 分 离 变量 ， 对 式 (4-43) 的 两 边 同时 左 乘 "Ti'(0,) 得 
TT 0)" T= 72(0)273(d3) 74(04) 


即 
cs 0 0lln. o. a: Px C2C4—8254 -CS4-S2C4 0 clstll 
-s! cr 0 Olln, o ay py| |s2catcys4 -ss4+czc4 0 S212 
0 0 10 六 | | 0 0 1 -a 
0 0 01 1 0 0 0 1 
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左右 矩阵 中 的 元 素 (1，4) 和 元 素 (2，4) 分 别 相等 ， 即 


cosO .D .+Ssin0| 。P =cosO * L,+/ 
| 1 °° Px 1° Py 2 "Lt2™tl (4-44) 
-sinO! * pe+cosO1 * py=sing, * L» 
由 以 上 两 式 联 立 可 得 
/1 17 
0 -al +O (4-45) 
LB+pr+py py 
其 中 ， 一 p=arctan 一 
21 VDPz+Py Px 
2) 求 关节 变量 0 。 由 式 (4-44 ) 可 得 
rsin( O) 一 
l = oa | (4-46) 
rcos(01-9) -lL 


其 中 ， 7 二 px+py; en 
Px 
3) 求 关节 变量 d3。 令 左右 矩阵 中 的 元 素 (3，4) 相等 ， 可 得 
ds=-p, (4-47) 
4) 求 关节 变量 04。 令 左右 矩阵 中 的 元 素 (1，1) 和 元 素 (2，1) 分 别 相等 ， 即 
“ntsingin,=cos0, * cosO4+sing, * sin04 


-sinO! * n+cosOin, =Sin0 * cos04—cos0, * sings 


由 以 上 两 式 可 求 得 





一 SinO * n,+cosOin, 
04 =arctan ~ |+0, 


cosO * ntsinOin, (448) 

至 此 ， 机 絮 人 的 所 有 运动 学 逆 解 都 已 求 出 。 在 逆 解 的 求解 过 程 中 只 进行 了 一 次 矩阵 道 
乘 ， 从 而 使 计算 过 程 大 为 简化 ， 从 9; 的 表达 式 中 可 以 看 出 它 有 两 个 解 ， 所 以 SCARA 机 器 人 
应 该 存在 两 组 解 。 运 动 学 分 析 提 供 了 机 器 人 运动 规划 和 轨迹 控制 的 理论 基础 。 

例 4-9 如 图 4-15 所 示 斯 坦 福 机 
器 人 及 各 连 杆 的 坐标 系 ， 各 连 杆 参 
数 见 表 4-5。 斯 坦 福 机 器 人 是 一 个 球 
坐标 手臂 ， 即 开始 的 两 个 关节 是 旋 
转 的 ， 第 三 个 关节 是 滑动 的 ， 最 后 
三 个 腕 关 闻 全 是 旋转 关节 。 杆 1 绕 
固定 坐标 系 的 zo 轴 旋 转 9,; 杆 2 绕 
杆 1 坐标 系 的 za 轴 旋 转 %; 杆 3 绕 
杆 2 坐标 系 的 z, 轴 平 移 d3 。 手 及 有 
三 个 转动 关节 ， 与 转动 关节 的 轴线 
相交 于 一 点 ， 杆 4 绕 杆 3 坐标 系 的 z 
轴 旋 转 4; 杆 5 绕 杆 4 坐标 系 的 za 
轴 旋 转 9;; 杆 6 绕 杆 5 坐标 系 的 zs 
轴 旋 转 06; x6、y6、z6 为 手 部 坐标 系 。 建 立 机 器 人 的 运动 学 方程 。 




































































图 4-15 ”斯坦 福 机 器 人 及 各 连 杆 坐标 系 
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表 4-5 斯坦 福 机 器 人 各 连 杆 参数 




















杆 件 号 关节 转角 0 距离 d 杆 长 a 扫 角 a 
1 0 0 0 -90° 
2 0, 中 0 90° 
3 0, ds 0 0° 
4 04 0 0 -90 
5 0s 0 0 90° 
6 06 H 0 0° 

















解 : 1. 求 斯 坦 福 机 器 人 正 运 动 学 解 

根据 各 连 杆 的 参数 和 章 次 变换 矩阵 公式 可 求 得 4;。 

1 坐标 系 与 10} 坐标 系 是 旋转 关节 连接 ， 如 图 4-16a 所 示 。|{1} 坐标 系 相 对 于 10| 
坐标 系 的 变换 过 程 是 : |1| 坐标 系 绕 10} 坐标 系 的 xo 轴 做 a =-90?" 的 旋转 ， 然 后 11} 坐 
标 系 绕 10} 坐标 系 的 z 做 变量 % 的 旋转 ， 所 以 

4i= 了 Rot(z,0 )Rot(x,al )= Rot(z,0)Rot(x,-90?)= 


c0 -0 0ITL 0 0 0 c0 0 -s0 0 
sb co 0 0llo 0 1 sg 0 co 0 
0 0 1olo -10o0l lo -1 0 0 
0 0 01 0 01 0 0 0 1 








> 2 | 
20 区 多 Dy 为 
7 2 
2 X3 2 a 
oC5™! | 所 
为 二 ” -一 一 


Xo = 2 2 
a) b) | 9) 
图 4-16 斯 坦 福 机 器 人 手臂 坐标 系 之 间 的 关系 
12} 坐标 系 与 11| 坐标 系 是 旋转 关节 连接 ， 连 杆 距离 为 4;,， 如 图 4-16b 所 示 。|2| 坐 
标 系 相对 于 {1} 坐标 系 的 变换 过 程 是 : 12} 坐标 系 绕 11} 坐标 系 的 xi 轴 做 ga,=90° 的 旋 
转 ， 然 后 12} 坐标 系 治 着 11} 坐标 系 的 2 轴 正 向 做 d, 距离 的 平移 ， 再 绕 11} 坐标 系 的 
zi 轴 做 变量 9, 的 旋转 ， 所 以 
A, = Rot(z,0,)Trans(0,0,d,) Rot(x,a, )= 














cb, -s0, 0 0]11 0 0 ol fco 0 s0, 0 
sb0, co 0 0llo 0 -1 0| 1s 0 -co 0 
人 | 
0 0 0100 0 1 0 0 0 1 


13} 坐标 系 与 12} 坐标 系 是 移动 关节 连接 ， 如 图 4-16c 所 示 。 |3| 坐标 系 沿 着 12| 
坐标 系 的 z, 轴 正 向 做 变量 ds 的 平移 。 所 以 


1 0 0 0 
0 1 0 0 
A;=Trans(0,0,d;)= 0 01, 
0 0 0 1 
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斯 坦 福 机 器 人 手腕 三 个 关节 都 是 转动 关节 ， 关 方 变 量 为 6,、0s 及 06。， 并 且 三 个 关节 的 
中 心 重合 。 下 面 根据 图 4-17 所 示 手 腕 坐标 系 之 间 的 关系 写 出 齐 次 变换 矩阵 44~46。 


ze 


1 疙 

xX4, ”4 

23h 为 品 Xs 罗 hzs x 
Do (Do 

2 力 了 了 34 pA 注 

3 Xa Xs5 


a) b) c) 
图 4-17， 斯坦福 机 器 人 手腕 坐标 系 之 间 的 关系 


如 图 4-17a 所 示 ，14| 坐标 系 相 对 于 13} 坐标 系 的 变换 过 程 是 : 14} 坐标 系 绕 13| 
坐标 系 的 x3 轴 做 os =-90?" 的 旋转 ， 然 后 绕 13} 坐标 系 的 z3 轴 做 变 : 量 0 的 旋转 ， 所 以 
44 =Rot(z,04) Rot(x,os)= Rot(z,0,) Rot(x,—90°)= 
co -s04 0 0IF1 0 0 0 c04 0 -s0 0 
s0 co 000 0 1 0| so 0 cb 0 
0 0 10 -1 0 0 0 -1 0 0 
0 0 010 0 01 0 0 0 1 
如 图 4-17b 所 示 ，15| 坐标 系 相 对 于 14} 坐标 系 的 变换 过 程 是 : 15} 坐标 系 绕 |4| 
坐标 系 的 x 轴 做 a; =90° 的 旋转 ， 然 后 绕 14} 坐标 系 的 z4 轴 做 变量 9; 的 旋转 ， 所 以 
4; = 了 Rot(z,0; )Rot(x,Qas )= Rot(z,0;s) Rot(x,—90°)= 





























[ew 








| co -s0; 0 0lr1 0 0 0 c0s 0 ss0 0 
s0s cb 0 0|10 0 -1 0| ls 0 -cb 0 
0 0 10ll01 0 0 |0 -1 0 0 
[0 0 0 1|1100 0 1 0 0 0 1 
如 图 4-17c 所 示 ，|6| 坐标 系 沿 着 15} 坐标 系 的 zs 轴 做 距离 了 的 平移 ， 并 绕 |5| 坐 
标 系 的 zs 轴 做 变量 96 的 旋转 ， 所 以 
cg -s6 0 0 
sg cg 0 0 
Ac=Rot(z,0¢) Trans(0,0,H)= 
0 0 1 区 
0 0 0 





| 1 
这 样 ， 所 有 杆 的 4 矩阵 已 建立 。 机 器 人 最 后 的 正 运动 学 解 是 相 邻 关节 之 间 的 6 个 变换 
和 抢 阵 的 乘积 





(4-49) 


Hsranc ORD 


n 
RT =07, =A1A,A;A4AsA6= 
n 


于 


n=cil cs(cacsce™—sas6) —s2sss6 ] -si1(s4csce +case ) 
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7y 二 3$1 [cs(cacsce—sas6) -ssss6 | tec1( sacsce tcase) 
n,=-s( Cacsc6—s4s6) -Css5s6 
0 三 C1 | 一 c2( C4C5C6 一 3486 ) 十 S73536 ] 一 SI 人 一 54C5C6 +case ) 
Oe | 一 c2( C4C5C6 一 3S436 ) 一 S23S536 ] 十 C1 ( 3S4C5C6 十 C486 ) 

0, =s,( C4C53S6 一 3S4C6 ) 十 C7S586 


Qu =cl(cac43S5+S2C5 ) —s158485 


ay =s1(C2C48s+s2C5 ) +C13S435 


Q: 三 一 92C435 十 C2785 
pi=cil csc4ssH-ss( csH-ds) ] -si(ssssH+d,) 
py=51 [cscassH-s,(csH-d;) |+ei(sassH+d, ) 
ps=-[ ccassH+tes( csH-d;)| 
2. 关于 斯 坦 福 机 器 人 入 运 云 动 学 解 的 推导 
a、d， 求 关节 变量 9, ~06, 其 中 0;=d;。 为 了 书写 简 


现在 给 出 7 了。 矩阵 及 各 杆 参 数 a、 
便 ， 假设 五 =0， 即 坐标 系 | 6} 


与 坐标 系 15} 原点 相 习 
Pu=cls2d3 一 S1d2 
py=s1S2d3+c1d, 


Pp:=C2d3 


1) 求 9,。A1! 左 乘 式 (4-49) 两 边 即 可 得 
AT!'T, =A,A;A4A ;As 


式 (4-50) 左 端 为 
cL 53S1 0 0 

四 0 0 -1 0| mm 
41 76= 0 
1 


式 中 , /是 缩写 ， 其 中 


因而 
1T, =A,A;A1A;A6= 
Cy( C4C5C6 8454) 5255S6 
$2( CaCsC6 -S5454) tc)sss6 
S4C4C6 tC4s6 


0 


SQ 


x Px 


SQ 


重合 。 此 时 





fii(n) fi1(0) fula) fu(p) 
y Py _ | fia(n) fial0) fisla) fislp) 


be Bl, Cn Tt aa fat py 


< 


1 0 


2 


fi12(i)=— 
fi13(i)=-s 


i=n,0,a 


一 c2( CaCsCc6 tsase ) 十 S7S586 


一 52( CaCsCc6 tsase ) 一 3S2S536 


0 0 1 


十 
S17。 cly 


CsC4sstssCs sods 
C3C455—S2Cs -Cod3 
34355 d2 


0 1 


式 (4-51) 中 元 素 (3，4) 与 式 (4-52) 中 元 素 (3, 4) 相等 ， 即 
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一 54C536 十 C4C6 
0 
fi3(p)=d, 
“SIPx 十 C1Py 


=d, 


(4-50) 


(4-51) 


(4-52) 





采用 


三 角 代 换 Pxr=recosp, Py=rsinp 
三 25 到 
其 中 ， 二 Px tpy ? p=arctan( p/p ) 


进行 三 角 代 换 后 可 解 得 





je 
01=arctan| 一 | -~arctan 一 -一 一 (4-53 ) 
x 生 rd3 

其 中 ， 正 、 负 号 对 应 的 两 个 解 对 应 于 9, 的 两 个 可 能 解 。 
2) 求 9,。 根据 式 (4-51) 和 式 (4-52) 中 元 素 (1，4) 和 元 素 (2，4) 分 别 相等 ， 可 得 






































人 =s2d; (4.54) 
-= 一 cd 
故 
0, -ee (4-55) 
Pz 
3) 求 9;。 在 斯 坦 福 机 器 人 中 9 =d3 ， 利 用 sin?b+cos"9=1， 由 式 (4-54) 可 解 得 
ds3=s2( cipx +s1py) te2p; (4-56) 
4) 求 6,。 由 于 To=AsAsA6， 所 以 
Ai! .3T, =AsAs (4-57) 
将 式 (4-57) 左 、 右 两 边 展开 后 取 其 左 、 右 两 边 第 三 行 第 三 列 相等 ， 得 
-s4[ cz(ascl+ as1) — azsz]+c4(-assl+ arcl)=0 
所 以 
0, | | 地 04 =04+180° (4-58) 
C2( Qc1+ays1) 一 023? 
5) 求 6;。 取 式 (4-57) 展开 式 中 元 素 (1，3) 和 元 素 (2，3) 相等 ， 有 
cal cs acl +a,si ) -as ] +sa( —a,si +ayCl )= 55 
( QuC1+QyS1) tascy =cs 
所 以 
05 = woton [cs arc1tays1) -ass2 ] ts4( ax31+ayCl "| (4-59) 
$2( QuC1+QyS1 ) tascy 
6) 求 06。 采 用 下 列 方程 : 
Pa rh (4-60) 
展开 并 取 其 中 元 素 (1，2) 和 元 素 (2, 2) 相等 ， 有 
56=-c5 | c4[ cz(oscl+oyS1) -0:32 | +sa( -0vS1+0yC1) | +ssL sa( oic1+0%s1) +0,c2 |] 
ce=—sal Ca( Oic1+0)81) ~—0ss2 | +c4( ~0%s1+0yc1 ) 
所 以 
06 -aol (4-61 ) 
C6 


至 此 A 六 0,、 da3 、 04、 0s、 0 全 部 求 出 。 
从 以 上 求解 的 过 程 看 出 ， 这 种 分 离 变量 法 是 代数 法 的 一 种 ， 它 的 特点 是 首先 利用 运动 方程 的 
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不 同形 式 ， 找 出 矩阵 中 简单 表达 茶 个 未 知 数 的 元 素 ， 力 求 得 到 未 知 数 较 少 的 方程 ， 然 后 求解 。 
4. 3.2 机 器 人 运动 学 逆 解 求解 过 程 中 存在 的 问题 


在 机 器 人 运动 学 逆 解 求解 过 程 中 ， 还 应 注意 以 下 三 个 问题 

1. 解 可 能 不 存在 

机 器 人 具有 一 定 的 工作 域 ， 假 如 给 定 手 部 位 置 在 工 
作 域 之 外 ， 则 解 不 存在 。 图 4-18 所 示 为 二 自由 度 平面 关 
节 机 械 手 ,假如 给 定 手 部 位 置 矢量 (x*，y) 位 于 外 半径 
为 L1+4 与 内 半径 为 |1 -1 | 的 圆 环 之 外 ， 则 无 法 求 出 逆 解 
01 及 9,， 即 该 逆 解 不 存在 。 

2. 解 的 多 重 性 

机 器 人 的 道 运动 学 问题 可 能 出 现 多 解 。 图 4-19a 表示 一 
个 二 自由 度 平面 关节 机 械 手 出 现 两 个 首 解 的 情况 。 对 于 给 定 图 4-18 工作 域外 逆 解 不 存在 
的 在 机 器 人 工作 域内 的 手 部 位 置 4(x，y) 可 以 得 到 两 个 逆 
解 : 0 、0; 及 901'、0,'。 从 图 4-19a 可 知 ， 手 部 不 能 以 任意 方向 到 达 目 标点 4。 增 加 一 个 手腕 关节 
自由 度 ， 如 图 4-19b 所 示 三 自由 度 平面 关节 机 械 手 ， 即 可 实现 手 部 以 任意 方向 到 达 目 标点 4。 





























一) 
a) b) 
图 4-19 ” 道 解 的 多 重 性 


在 多 解 情况 下 ， 一定 有 一 个 最 接近 解 ， 即 最 接近 起 始点 的 解 。 图 4-20a 表示 3R 机 械 手 
的 手 部 从 起 始点 4 运动 到 目标 点 了 B， 完 成 实 线 所 表示 的 解 为 最 接近 解 ， 是 一 个 “最 短 行程 ” 
的 优化 解 。 但 是 ， 如 图 4-20b 所 示 ， 在 有 障碍 存在 的 情况 下 ， 上 述 的 最 接近 解 会 引起 碰撞 ， 
只 能 采用 男 一 解 ， 如 图 4-20b 中 实 线 所 示 。 尽 管 大 臂 、 小 臂 将 经 过 “遥远 ”的 行程 ， 为 了 避 
人 免 碰 撞 也 只 能 用 这 个 解 ， 这 就 是 解 的 多 重 性 带 来 的 好 处 。 




















a) b) 


图 4-20 ”避免 碰撞 的 一 个 可 能 实现 的 解 
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关于 解 的 多 重 性 的 男 一 实例 如 图 4-21 所 示 。PUMA560 机 器 人 实现 同一 目标 位 置 和 姿态 有 四 
种 形 位 ， 即 四 种 解 。 另 外 ， 腕 部 的 “翻转 ”又 可 能 得 出 两 种 解 ， 其 排列 组 合共 可 能 有 8 种 解 。 

3. 求解 方法 的 多 样 性 

机 老人 道 运动 学 求解 有 多 种 方法 ， 一 般 分 为 两 类 : 封闭 解 和 数值 解 。 不 同学 者 对 同一 机 
器 人 的 运动 学 逆 解 也 提出 了 不 同 的 解法 。 应 该 从 计算 方法 的 计算 效率 、 计 算 精 度 等 要 求 出 
发 ， 选 择 较 好 的 解法 。 


4. 3.3 机 器 人 的 退化 和 灵巧 特性 


1. 退化 

当 机 器 人 失去 一 个 自由 度 ， 并 因此 不 按 所 期 望 的 状态 运动 时 即 称 为 机 器 人 发 生 了 退化 。 
在 两 种 条 件 下 会 发 生 退 化 : 中 机 器 人 关节 达到 其 物理 极限 而 不 能 进一步 运动 ; @ 如 果 两 个 相 
似 关节 的 z 轴 共 线 ， 机 器 人 可 能 会 在 其 工作 空间 中 变 为 退化 状态 。 这 意味 此 时 无 论 哪个 关节 
运动 都 将 产生 同样 的 运动 ， 结 果 是 控制 器 将 不 知道 是 哪个 关节 在 运动 。 无 论 哪 一 种 情况 ， 机 
器 人 的 自由 度 总 数 都 小 于 6， 因 此 机 器 人 的 方程 无 解 。 在 关节 共 线 时 ， 位 置 矩 阵 的 行列 式 也 
为 零 。 图 4-22 所 示 为 一 个 处 于 垂直 构 型 的 简单 机 器 人 ， 其 中 关节 1 和 6 共 线 。 可 以 看 到 ， 
无 论 关节 1 或 关节 6 旋转， 末端 执行 器 的 旋转 结果 都 是 一 样 的。 实际 上 ， 这 时 指令 控制 器 采 
取 紧 急行 动 是 十 分 重要 的 ， 否 则 机 器 人 将 停止 运行 。 应 注意 ， 这 种 情况 只 在 两 关节 相似 时 才 
会 发 生 ， 反 之 ， 如 果 一 个 关节 是 滑动 型 的 ， 而 男 一 个 是 旋转 型 的 ( 如 斯 坦 福 机 械 手 臂 的 关 
节 3 和 关节 4) ， 那 么 即使 它们 的 z 轴 共 线 ， 机 器 人 也 不 会 出 现 退 化 的 现象 。 


| 
> 泛 1 
a) b) ED 


图 4-21 机 器 人 运动 学 道 解 图 4-22 ”处 于 垂直 构 型 的 机 吉 人 
a) PUMA560 机 器 人 的 四 个 逆 解 b) 手腕 “翻转 ”的 两 种 逆 解 
需要 指出 : 如 果 sina4 、sinas ,或 sinas 为 0， 机 和 右 人 就 将 退化 。 显 然 ， 可 以 适当 设计 oy 和 
as 来 防止 机 器 人 退化 。 此 外 ， 如 果 任 何 时 候 9; 接近 0° 或 者 180*， 机 器 人 就 将 变 成 退化 状态 。 
2. 灵巧 
一 般 认为 只 要 确定 了 机 器 人 手 的 位 姿 ， 就 能 为 具有 六 个 自由 度 的 机 器 人 在 其 工作 范围 内 
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的 任何 位 置 定位 和 定 姿 。 实 际 上 ， 随 着 机 器 人 越 来 越 接近 其 工作 空间 的 极限 ， 虽 然 机 器 人 仍 
可 能 定位 在 期 望 的 点 上 ,但 却 有 可 能 不 能 定 姿 在 期 望 的 位 姿 上 。 能 对 机 器 人 定位 但 不 能 对 它 
定 姿 的 点 的 区 域 称 为 不 灵巧 区 域 。 


4.4 机 器 人 雅 可 比 窍 阵 的 建立 及 分 析 


本 节 将 在 位 移 分 析 的 基础 上 ， 进 行 速度 分 析 ， 研 究 操作 空间 与 关节 空间 之 间 的 映射 关 
系 一 一 雅 可 比 和 矩阵 (简称 雅 可 比 )。 雅 可 比 矩 阵 不 仅 用 来 表示 操作 空间 与 关节 空间 之 间 的 速 
度 线 性 映射 关系 ， 同 时 也 用 来 表示 两 空间 之 间 力 的 传递 关系 ， 为 确定 机 器 人 的 静态 关节 力矩 
以 及 不 同 坐标 系 间 速度 、 加 速度 和 毅力 的 变换 提供 了 便捷 的 方法 。 


4.4.1 机 器 人 的 速度 雅 可 比 (Jacobians) 矩阵 


在 机 融 人 学 中 ， 雅 可 比 是 一 个 把 关节 速度 矢量 9 变换 为 手 部 相对 基 坐 标的 广义 速度 矢量 
”的 变换 和 矩阵。 在 机 咒 人 速度 分 析 和 静 力 分 析 中 都 将 用 到 雅 可 比 。 数 学 上 雅 可 比 是 一 个 导数 
的 多 维 形式 。 例 如 ， 假 定 有 6 个 函数 ， 每 一 个 均 有 6 个 独立 变量 : 


人 | =f1(x1 )X%2 ,NX3 ,NX4,X5 ,X6 ) 


















































大 = 万 (xl ,x2 ,X3,X4, Xs5 ,XG ) (4-62 ) 
6=fe( x1,X2 ,Xa ,X4 ,Xs ,XG ) 
也 可 以 用 矢量 符号 把 这 些 方程 写 为 
Y=F(X) 
现在 如 果 要 计算 y, 作为 *; 的 函数 的 微分 ， 可 以 简单 地 应 用 复合 微分 定律 来 计算 
0 
9y1= 了 二 n Ox¢ 
9 Oy Owe 
2 oj )f» 
TR TR (4-63) 
0 0 
y6= sp 6 
Xl OX 0 
它 同 样 可 以 用 矢量 符号 写 得 更 简单 些 
F 
d = 用 


式 中 的 6x6 偏 导数 矩阵 > 元 称 为 雅 可 比 敌阵 ， 用 符号 了 来 表示 。 注 意 : 如 果 方 程式 是 非 


线性 的 ， 则 偏 导数 为 x; 的 函数 。 所 以 有 下 面 的 符号 
dY=J() dx¥ 
以 二 自由 度 平面 关节 型 机 器 人 (2R 机 器 人 ) 为 例 ， 如 图 4-23 所 示 ， 其 端点 位 置 (x，y) 
与 关节 变量 9, 、0, 的 关系 为 
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X=licosO+lcos(O+O0 ) 
| 1 1702 1702 (4-64) 
y=lsinOi +l,sin( 0 +0, ) 
即 
x=x(0,,0,) 
| es (4-65) 
y=7y(01 ,0,) 


将 其 微分 ， 得 








Ox Ox 
dx=——d0,+——d0 
~ 00 ! 980, ? 





0 9 
dy=- dO0,+ dd0, 
901 00, 图 4-23 二 自由 度 平 面 关节 型 机 器 人 




















将 其 写成 矩阵 形式 为 
dx 90! 9090, || db， 
网。 (4.66) 
| 本 | 
900 00， 
令 : 
00 00， 
J= (4-67) 
3 
00 960， 
式 (4-66) 可 简写 为 
dX=Jd0 (4-68) 
d d0 
其 中 ， dx | so- 
dy d0, 


了 称 为 图 4-23 所 示 二 自由 度 平面 关节 型 机 恬 人 的 速度 雅 可 比 和 矩阵 ， 它 反映 了 关 市 空间 
微小 运动 d 与 手 部 作业 空间 微小 位 移 dX 之 间 的 关系 。 
若 对 式 (4-67) 进行 运算 ， 则 2R 机 器 人 的 雅 可 比 矩 阵 写 为 
攻 sin0i -lysin(01+0,) -il,sin( O01+0,) 








4-69 
licosOitlycos(01+0,) lycos(01+0,) ( ) 


从 J 中 元 素 的 组 成 可 见 ，J 的 值 是 0, 及 0, 的 函数 。 

对 于 自由 度 机 器 人 ， 关 节 变 量 g[ gi ,gqg， … g,] ， 当 关节 为 转动 关节 时 ，g,=0,; 当 
关节 为 移动 关节 时 ，g;=d;, 则 dq=[dqt dq。 … dg,] 反映 关节 空间 的 微小 运动 。 
由 兰 = 耻 (gq) 可 知 

dX=J(g)d(gq) (4-70) 

其 中 ,J(qg) 是 6xn 的 偏 导 数 和 矩阵 ， 称 为 n 自由 度 机 器 人 速度 雅 可 比 和 矩阵 。 

把 两 边 除 以 时 间 元 素 的 微分 ， 可 以 把 雅 可 比 看 作为 把 g 中 的 速度 映射 到 对 中 ， 即 

X=J(g)g (4-71) 
在 任 一 特定 的 瞬时 ,gq 具有 一 定 的 值 ， 而 J(q) 为 一 线性 变换 ， 在 每 一 个 新 的 瞬时 ，g 
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变 了 ， 因 此 这 个 线性 变换 也 变 了 ， 雅 可 比 是 随时 间 变 化 而 变化 的 线性 变换 。 
在 机 器 人 学 的 领域 内 ， 人 们 一 般 谈 的 是 关于 关节 速度 与 机 械 手 端 部 速度 间 关 系 的 雅 可 
比 。 例 如 





也 





v=J(g)gq (4-72) 
式 中 “4 一 一 机 器 人 的 关节 变量 ; 
”一 一 机 器 人 手 部 在 操作 空间 中 的 广义 速度 ，v = 不; 
4 一 一 机 器 人 关节 在 关节 空间 中 的 关节 速度 (角速度 或 线 速度 ) 。 
注意 ， 对 于 任何 给 定 的 机 器 人 构 型 ， 关 节 速 度 和 端 部 速度 之 间 的 关系 为 线性 的 ， 这 仅 是 
一 种 瞬时 关系 ， 因 为 在 下 一 瞬时 ， 雅 可 比 要 稍微 变化 一 点 。 对 于 在 三 维 空间 中 作业 的 一 般 六 
自由 度 机 器 人 ， 其 速度 雅 可 比 了 是 一 个 6x6 矩阵 ，4 和 vw 分别 是 6x1 列 阵 ， 即 wexn = 
J(g) exojgvexn 。 手 部 速度 矢量 " 是 由 3x1 线 速度 矢量 和 3x1 角速度 矢量 组 合 而 成 的 6 维 列 
矢量 。 即 手 部 在 基 坐 标 系 中 的 广义 速度 矢量 为 


v oe 
"=| | y 2 Ww wy w,] 
CO 

















式 中 "一 一 线 速 度 ; 

wo 一 一 角速度 。 

关节 速度 矢量 gqg 是 由 6 个 关节 速度 组 合 而 成 的 6 维 列 矢 量 。 雅 可 比 和 矩阵 .y 的 前 三 行 代表 
手 部 线 速度 与 关节 速度 的 传递 比 ; 后 三 行 代表 手 部 角速度 与 关节 速度 的 传递 比 。 而 雅 可 比 矩 
阵 了 的 第 i 列 则 代表 第 i 个 关节 速度 g ,对手 部 线 速度 和 角速度 的 传递 比 。 

对 于 图 4-23 所 示 2R 机 器 人 来 说 ，J(g) 是 式 (4-69) 所 示 的 2x2 矩阵 。 若 令 万 、. 分 
别 为 式 (4-69) 所 示 雅 可 比 的 第 一 列 矢 量 和 第 二 列 矢 量 ， 则 式 (4-72) 可 写成 

v=J101+]20 

其 中 ,右边 第 一 项 表示 仪 由 第 一 个 关节 运动 引起 的 端点 速度 ; 右边 第 二 项 表示 仅 由 第 二 
个 关节 运动 引起 的 端点 速度 ; 总 的 端点 速度 为 这 两 个 速度 矢量 的 合成 。 因 此 ， 机 器 人 速度 雅 
可 比 的 每 一 列表 示 其 他 关节 不 动 而 某 一 关节 运动 产生 的 端点 速度 。 

图 4-23 所 示 二 自由 度 平 面 关 节 型 机 器 人 手 部 的 速度 为 


Tv] f=lising Lsin(01+0,) -lsin(01+0,) || 6 
licos0i+l,c( 01+0,) lycos( 01+0,) 六 


























Ly 





no it 0 症 和 汪 刘 
| [iicosOi+lsc( 01+0,) ]O'+l,cos( 01+0,)0, 
假如 lb 及 见 是 时 间 的 函数 ，0 =fi(t)，0,=p(t) ， 则 可 求 出 该 机 器 人 手 部 在 某 一 时 刻 的 
速度 v=f(t) ， 即 手 部 瞬时 速度 。 
反之 ， 假 如 给 定 机 器 人 手 部 速度 ， 可 由 式 (4-72) 解 出 相应 的 关节 速度 ， 即 
qg=J ly (4-73) 
其 中 ， 斑 ' 称 为 机 器 人 道 速 度 雅 可 比 。 





瑟 
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例 4-10 ”如 图 4-24 所 示 二 自由 度 机 械 
手 ， 手 部 沿 固定 坐标 系 xo 轴 正 向 以 1. 0m/s 
的 速度 移动 ， 杆 长 4 =1, =0.5m。 设 在 某 瞬 
时 0, = 30°*，9, =-60",， 求 相应 瞬时 关节 
速度 。 

解 : 对 于 二 杆 机 械 手 的 情况 ， 可 以 写 出 
一 个 2x2 雅 可 比 ， 它 表明 关节 速度 对 终端 效 
































应 器 速度 的 关系 。 由 式 (4-69) 可 以 确定 二 图 4.24 “二 自由 度 机 械 手 
杆 机 械 手 的 雅 可 比 和 矩阵 为 
-lisi-lssiy -lzs12 
(a) 
/ci+/ciz /ci 
因此 逆 雅 可 比 和 矩阵 为 
1 /cl /231 
A (D) 
iss -lici-lacry -lisi-lzs12 


由 式 (4-73) 可 知 0=Jriy， 且 v= [1 0]7,， 即 ww=1.0m/s, w =0， 因 此 


01 1 | lyc12 ls12 | 
0 ps ebey, -lisi-bsy |L0 


” cl cos(30°-60°) 1 
0 = 二 -= d/s=- 一 rad/s=-2rad/ 
1 1s 0.5xsin(-60°) 0 











C1 C12 cos30° q/ cos(30°-60°) 
= rad/s— 


Ee d/s=4rad/ 
/2s /is 0.5xsin( -60°) 0. 5xsin( -60°) s=4rad/s 





因此 ， 在 该 瞬时 两 关节 的 位 置 分 别 为 0, = 30°*，9, =-60°; 速度 分 别 为 9, = -2rad/s， 
9,=4rad/s; 手 部 瞬时 速度 为 1. 0m/s。 
4.4.2 静 力 域 中 的 雅 可 比 和 矩阵 


现在 我 们 可 以 将 各 关节 之 间 的 力 和 力矩 进行 变换 。 首 先 解 决 把 作用 在 末端 操作 器 上 的 力 
和 力矩 与 等 效 关节 力 和 力矩 联系 起 来 的 问题 。 即 运用 作用 在 末端 操作 器 上 的 力 和 力矩 所 做 的 
虚 功 与 各 关节 上 所 做 的 虚 功 相等 的 方法 。 也 就 是 
SW=F'D=7'Q (4-74) 
其 中 ,7 是 广义 关节 力 的 列 矢 量 ， 广 义 关 节 力 对 于 转动 关节 而 言 是 力矩， 对 于 移动 关节 而 言 
是 力 ; 8 是 关节 虚 位 移 的 列 和 失 量 ,， 对 于 转动 关节 是 转动 6986， 对 于 移动 关节 则 是 移动 4; D 
是 末端 操作 器 的 虚 位 移 。 于 是 对 于 斯 坦 福 操 作 手 ， 关 节 虚 运动 所 做 的 虚 功 为 
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SW=[7T, 7T, 5 To] 





60; 
606 


(4-75) 


其 中 ， 是 关节 力矩 ， 而 Fs 是 作用 在 移动 关节 3 上 的 力 。 回 到 式 (4-74) ， 如 果 操 作 手 处 


于 平衡 状态 ， 


将 九 =JCQ 代入 得 到 


则 所 做 的 虚 功 为 零 ， 而 


F'D=7'Q 


FJQO=7'0 


这 一 公式 与 虚 位 移 Q 无 关 ， 于 是 


或 


FIJ=7' 


7=J'F 


(4-76) 


(4-77) 


(4-78) 


这 是 一 个 重要 的 关系 。 也 就 是 已 知 在 机 带 人 手 部 上 的 作用 力 和 力矩 ， 式 (4-78) 给 出 为 
了 保持 平衡 而 必须 施加 于 操作 手 关 节 上 的 力矩 和 力 。 如 果 操 作 手 在 作用 力 和 力矩 的 方向 上 自 
由 运动 ， 则 在 式 (4-78) 所 确定 的 关节 力矩 和 力作 用 下 将 会 在 手 部 得 到 设 定 的 力 和 力矩 的 作 
用 。 该 公式 对 任何 自由 度数 的 操作 手 都 成 立 。 式 中 三 与 手 部 端点 力 环 和 广义 关节 力矩 了 之 
间 的 力 传递 有 关 ， 称 为 机 器 人 力 雅 可 比 矩 阵 。 显 然 机 器 人 力 雅 可 比 六 是 速度 雅 可 比 J 的 转 


置 矩 阵 。 
例 4-11 



































斯 坦 福 操作 手 处 于 如 下 的 位 姿 : 


0 1 0 20 
1 0 0 6.0 
T= 
0 0 -1 0 
[lo 0 0 1 





它 相应 于 在 表 4-6 中 给 出 的 正弦 和 余弦 的 关节 坐标 。 





坐标 


表 4-6 操作 手 状态 
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数值 正弦 
0 0 
90° 1 
20in 
0 0 
90° 1 
90° 1 
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雅 可 比 和 矩阵 为 
[20.0 0.0 0.0 0.0 0.0 0.0 
-6.0 0.0 1.0 0.0 0.0 0.0 
dTe | 0.0 20.0 0.0 0.0 0.0 0.0 
doq |0.0 10 0.0 0.0 1.0 0.0 
0.0 0.0 0.0 1.0 0.0 0.0 
[|-1.0 0.0 0.0 0.0 0.0 1.0 
操作 手 末端 产生 的 力 和 力矩 为 
TF= [0 0 100 0 -200 1000]7 
求 所 需 的 关节 力 和 力矩 。 
解 : 用 式 (4-78) 得 到 关节 力 和 力矩 为 
| fr20 -56000 -ro0 -1000 
72 0 0 20 10 0 0 2000 
Ra| I0 1 000 0|l10|| 0 
Ti|lI0 0 001 0|| 0 | |-200 
7, 0 0 0 1 0 0||-200 0 
lr io 0 0 00 1JL1000) L1000 














4. 4. 3 ”机 器 人 雅 可 比 和 矩阵 求法 


在 机 器 人 学 中 , 了 是 一 个 把 关节 速度 矢量 g; 变换 为 手 部 相对 基 坐 标的 广义 速度 矢量 的 
变换 矩阵 。 在 三 维 空间 运行 的 机 器 人 ， 甚 y 的 行 数 恒 为 6 ( 治 / 绕 基 坐 标 系 的 变量 共 6 个 )， 
列 数 则 为 机 械 手 含有 的 关节 数目 。 

对 于 平面 运动 的 机 带 人 来 说 ,， 手 的 广义 位 置 拓 量 [x y wp]" 容易 确定 ， 可 采用 直接 微 
分 法 求 J， 比 较 方便 。 对 于 三 维 空间 运行 的 机 絮 人 则 不 完全 适用 。 从 三 维 空间 运行 的 机 带 人 
运动 学 方程 ， 可 以 获得 直角 坐标 位 置 拓 量 [x y z]' 的 显 式 方程 ， 因 此 ,J 的 前 三 行 可 以 
直接 微分 求 得 ， 但 不 可 能 找到 方位 矢量 [pg。 pg， 8.] 的 一 般 表达 式 。 找 不 出 互相 独立 的 、 
无 顺序 的 三 个 转角 来 描述 方位 。 绕 直角 坐标 轴 的 连续 角 运 动 变 换 是 不 可 交换 的 ， 而 对 角 位 移 
的 微分 与 对 角 位 移 的 形成 顺序 无 关 ， 故 一 般 不 能 运用 直接 微分 法 来 获得 J 的 后 三 行 。 因 此 ， 
常用 构造 法 求 雅 可 比 J。 

构造 雅 可 比 矩 阵 的 方法 有 矢量 积 法 和 微分 变换 法 ， 雅 可 比 矩 阵 J(qg) 既 可 当成 是 从 关节 

空间 向 操作 空间 的 速度 传递 的 线性 关系 ， 也 可 看 成 是 微分 运动 转换 的 线性 关系 ， 即 


v=J(g)g, dX=J(g)dg 
对 于 有 nn 个 关节 的 机 器 人 ， 其 雅 可 比 和 矩阵 J(q) 是 6xn 阶 算 了 泗 ， 其 前 三 行 称 为 位 置 雅 可 


比 和 矩阵， 代表 对 手 部 线 速度 ” 的 传递 比 ， 后 三 行 称 为 方位 矩阵 ， 代 表 相 应 的 关节 速度 gq; 对 
手 部 的 角速度 w 的 传递 比 。 因 此 ， 可 将 雅 可 比 矩 阵 J(g) 分 块 ， 即 



































三 
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ql 
[|- Jn Jp g; (4.79) 
4 J J J : 

| 9， 





式 中 .JJ 太一 关节 ;的 单独 关节 速度 引起 的 手 部 的 线 速度 和 角速度 。 
手 部 的 线 速度 ”和 角速度 w 可 以 表示 为 
v=JnqitJrq2t" t+) q, 
| 8 (4-80) 
@=J,q91+] 0292+ +) ,qd 
类 似 地 ， 机 器 人 手 部 的 微分 移动 拓 量 d 和 微分 转动 矢量 5 与 各 关节 的 微分 运动 dg 之 间 
的 关系 有 





d=Jndqit+Jpdgqs+.…+) dq, 
nn +Jodg2+…+7wdgn 
式 中 hi、J 一 一 关节 i 的 单独 微分 运动 引起 的 手 部 的 微分 移动 和 微分 转动 。 
下 面具 体 介绍 构造 雅 可 比 和 矩阵 的 方法 。 
1. 矢量 积 法 求 雅 可 比 和 矩阵 
(1) J 的 求法 
1) 如 图 4-25 所 示 ， 若 第 i 个 关节 
为 移动 关节 ， 则 
qi;=d;, qi=d; 
设 某 时 刻 仅 此 关节 运动 ， 其 余 的 关 
节 静 止 不 动 ， 则 


y=J1g, (4-82) 

设 b, | 为 z;-1 轴 上 的 单位 矢量 ， 利 

用 它 可 将 局 部 坐标 下 的 平移 速度 d, 转 
换 成 基础 坐标 下 的 速度 . 

= 1d, (4-83) 图 4-25 ” 仪 平移 关节 产生 的 线 速度 


(4-81) 














由 于 qi=d;， 所 以 
Ji=b; 1 (4-84) 
2) 如 图 4-26 所 示 ， 若 第 i 个 关节 为 转动 关节 ， 则 gq,=0,。 设 某 时 刻 仅 此 关节 运动 ， 其 
余 的 关节 静止 不 动 ， 仍 然 利 用 b, ,将 z,_, 轴 上 的 角速度 转化 到 基础 坐标 中 去 ， 则 





w,=b,10, (4-85) 
矢量 x 1 ,起 于 0; ， 止 于 0,， 所 以 由 mw; 产生 的 线 速 度 为 
Vo = 0;Xr;1, 6 (4-86) 
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由 式 (4-82) 、 式 (4-85) 得 
Jiqi= (bi10,) Xr ,= (bx,) 0 
由 于 g,=0,， 所 以 
J1=b; 1Xr, 
(2) J 的 求法 
1) 若 第 i 个 关 市 为 移动 关节 时 , 仍 有 


(4-87) 








qi=d;，9;=d;。 由 于 关节 移动 的 平移 不 对 手 /yy 
部 产生 角速度 ， 所 以 此 时 十 or 
Ju=0 (488) 7 7 


2) 第 i 个 关节 为 转动 关节 时 ，g; = 图 4-26 仅 施 续 关节 产生 的 线 速度 
0;，@;=Jiq;=b;10;， 所 以 


Ju=Di-1 (4-89) 
因此 由 式 (4-84)、 式 (4-87) ~ 式 (4-89) 可 知 


当 第 i 个 关节 为 移动 关节 时 
a 4-90 
J -| 0 | . 


J bi_iXrii,。 (4.91) 
esd bi | 
(3) 确定 b;_ 1， Ti_1,e 


1) 确定 b, |。 用 4b 表示 z,1 轴 上 的 单位 矢量 ， 则 


0 
1 
把 它 转换 到 基础 坐标 系 中 ， 即 为 
bi =°Ri(gI ) 'R,( gq,) “Ri ( gi )b (4-92) 2 
2) 确定 7 1。。 如 图 4-27 所 示 , 用 0O、0,1、0, 分 
别 表示 基础 坐标 系 ，i-1 号 坐标 系 及 手 部 坐标 系 的 原点 。 
用 矢量 x 表示 在 各 自 坐 标 系 中 的 原点 ， 用 齐 次 坐标 表示 


当 第 i 个 关节 为 转动 关节 时 


b= 

















O Ni-l,e 
为 : x=[0 0 0 1]7。 
mr- ,=00,-00.1 (4-93) a 
关节 i-1 坐标 系 原点 用 齐 次 坐标 表示 ， 则 有 a 
图 4-27 基础 坐标 系 、|i-1| 
Xi i 坐标 系 及 手 部 坐标 系 间 关 系 


由 式 (4-93) 可 知 
pe py Pp: 1] -A(g) 4 :i A; 1(gi1)x (4-94) 
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由 上 式 可 确定 Fle 

例 4-12 如 图 4-28 所 示 二 自由 度 机 械 手 ， 建 立 其 雅 
可 比 矩 阵 。 

解 : 1) 求 J,。 由 式 (4-87) 可 得 





L J k 
Jn =boxro, 。= 0 0 J 二 
licitlyscr» lisitlssi» 0 





-L181—L815 


licitlsci 


图 4-28 二 自由 度 机 械 手 





0 
; J k -ls12 
Jn=bixri,.=| 0 0 1|=| be, 
pc bs 0 0 


式 中 ,i 六 分 别 表示 x、y、z 坐标 轴 的 单位 矢量 。 
2) 求 J,。 由 式 (4-89) 可 得 











0 0 
Ju=bo=|0|, Ji=b1=10 
1 1 
所 以 雅 可 比 和 矩阵 为 
| -11s1-12s1 一 02s1> 
/icl+l2ciz /ci 
Jn J 
J= | | = 0 0 
Ja Jo 0 0 
0 0 
LE 1 1 
-lsi-lssiy -ls12 
可 简写 成 J=| 1ncli+lc bcy 


1 1 
2. 微分 变换 法 求 雅 可 比 和 矩阵 
(1) 微分 运动 与 广义 速度 刚体 或 坐标 系 的 微分 运动 包括 微分 移动 矢量 d 和 微分 转 
动 矢 量 65。 前 者 由 治 三 个 坐标 轴 的 微分 移动 组 成 ， 后 者 由 绕 三 个 坐标 轴 的 微分 转动 组 
成 ， 即 





d=d,itdyjtd.k 或 d= [d,d,，d.]" 


人 7 


6=6.i+6,j+6.k 或 6= [5，5，5.] 





刚体 或 全 标 系 的 做 分 运动 矢量 =| | 
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| fn ny ns (pxn), (pxn), (pxn)s|[d, 
dy | Jo, 0, 0 (pxo)。 (pxo), (pxo):|| 
Td | la, a, a (pxXa), (pxa), (pxa),||d, 
- (4-95) 
76, 0 0 0 7 7 n 6, 
76， 0 0 0 o。， 0 0, 6, 
re | 10 0 0 a a, 六 ol. 
简写 为 
id| |RI -R'S(P) |fd 
7 | = (4-96 ) 
6 0 Rr! 6 
其 中 ,，R 是 旋转 矩阵 R=|n, o, a, 
S(P) 为 矢量 己 的 反对 称 和 矩阵 
0 -pp pp; 
S(P)= Pz 0 Px (4-97) 
p; Pp: 0 
S(P) 和 窍 阵 具有 以 下 性 质 . 
S(P)w=Pxw, S(P)6=Px6 (4-98) 
w'S(P)=-(Pxw)!', 6'S(P)=-(Px6) (4-99) 
相应 地 ， 广 义 速度 的 坐标 变换 为 
Ty R' -RISCP) |[y» 
» |= ls (4-100) 
CO 0 R CO 
(2) 微分 变换 法 求 雅 可 比 和 矩阵 ”对 于 转动 关节 
0 0 
d=|0|, 5=|0|d0， 
0 1 
由 式 (4-95) 有 
| 7a, | | (pxn), 
dy | | (pxo), 
Td, (pxa), 
7 |= dg, (4-101) 
0, n, 
76, 0; 
| "8. | Q, 
对 于 移动 关节 
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0 
d=| 0 ldd,, 6=|0 
0 
由 式 (4-95) 有 
Fr 
"qd, » 
T7 1 
| =| "laq, 4-102 
ry =| le (4-102) 
"6, 0 
TS LO 
由 此 可 得 雅 可 比 和 矩阵 J。 
对 于 转动 关节 
| (pxn), 
(pxXo), 
xa 
2 这 V0 (4-103) 
对 于 移动 关节 
?J =| (4-104) 
0 
0 
[0 
例 4-13 ”如 图 4-15 所 示 斯 坦 福 六 自由 度 机 器 人 ， 除 第 三 关节 为 移动 关节 外 ， 其 余 5 个 





关节 为 转动 关节 。 试 用 微分 法 计算 1J(g)。 
解 : 根据 式 (4-103)、 式 (4-104) 求 77 
| -ds [es(cacsco—sase) -sssce ] +ssda( Sacsce tcase ) 
-ds[ -cs( cacssetsace ) ts2ssse | ts2da( -54C536+C4C5 ) 
—d, (ccasstsscCs ) +ssd3545s 
丘 属 下 
82( C2C456 $4C6 ) ~C28556 


$2( CoC4S6+84C6 ) tC sssG 





一 S2C4S5 十 C2 C5 
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| da( cscsc6—sase6 ) [ -ssc6 
-ds(cacscetsace) ssc6 
ry, a dacass , 7], _| 55 
34C5C6 十 C486 0 
一 54C536+C4C6 0 
| 34355 | 0 
ne 站 
0 0 
"Ja= ， "Js= ， “Je= ， 
S566 56 0 
$5C6 ce 0 
| 55 L 0 = 1 
4.4.4 ” 雅 可 比 和 矩阵 参考 坐标 系 的 变换 
已 知 坐标 系 1B| 中 的 雅 可 比 矩 阵 ， 即 
By 





要 想 知 道 给 出 的 雅 可 比 和 矩阵 在 男 一 个 坐标 系 14} 中 的 表达 式 。 首 先 注意 到 已 知 坐 标 系 中 的 
速度 矢量 可 以 通过 如 下 变换 得 到 相对 于 坐标 系 14} 的 表达 式 





网 “R 0 | 
宇 (4-106) 
‘0w 0 ‘RIL’w 
因此 ， 可 得 
Ay “R 0 : 
Pa 1 | T(0g (4-107) 
wj |0 iR 
由 以 上 关系 式 可 得 
， ‘R 0 
J(gq)= 1 | 7(q) (4-108) 
0 iR 








显然 ， 利 用 式 (4-108) 可 以 完成 雅 可 比 矩 阵 参考 坐标 系 的 变换 。 
4.4.5 机 器 人 雅 可 比 和 矩阵 分 析 


1. 奇异 点 

已 知 有 一 个 有 关 关 节 速 度 的 直角 坐标 速度 的 线性 变换 ， 请 考虑 一 个 问题 : 这 个 矩阵 是 否 
可 以 求 道 ? 也 就 是 ， 它 是 不 是 非 奇异 的 ? 如 果 这 个 矩阵 不 是 非 奇 异 的 ， 则 可 以 通过 式 
(4-73) 对 它 求 逆 来 计算 给 定 直角 坐标 速度 的 关节 速度 。 

式 (4-73) 是 一 个 重要 的 关系 式 。 例 如 ， 计 划 证 机 器 人 的 手 以 一 定 的 矢量 速度 在 直角 坐 
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标 空间 运动 ， 用 式 (4-73) 可 以 计算 沿 着 轨迹 的 每 个 瞬时 所 需 的 关节 速度 。 真 正 的 可 道 性 问 
题 是 : 雅 可 比 是 否 对 所 有 的 gq 值 都 可 以 求 道 。 如 果 和 否 ， 在 何 处 它 不 可 以 求 着 ? 所 有 的 操作 机 
都 有 雅 可 比 成 为 奇异 的 4 值 。 这 些 位 置 被 称 为 机 构 的 奇异 点 ， 或 简称 为 奇异 点 。 所 有 的 操作 
机 在 它们 的 工作 空间 的 边界 处 有 奇异 点 ， 而 大 多 数 在 它们 的 工作 空间 内 有 奇异 点 的 轨迹 。 

例 4-14 何 处 是 图 4-24 所 示 简 单 二 自由 度 机 械 手 的 奇异 点 ?这 些 奇异 点 的 物理 意义 是 
什么 ? 它们 是 工作 空间 边界 奇异 点 还 是 内 奇异 点 ? 

解 : 为 了 求 一 个 机 构 的 奇异 点 ， 必 须 考 察 其 雅 可 比 的 行列 式 。 在 行列 式 等 于 零 的 地 方 ， 
雅 可 比 降 秩 ， 是 奇异 的 。 

令 例 4-10 中 式 (a) 的 行列 式 等 于 零 ， 则 


-As1-0si2 -lsi 

















=1ils;=0 








lctlcy lcy 
显然 ， 当 9, 为 0 或 180° 时 ， 机构 有 一 个 奇异 点 。 从 物理 意义 上 说 ， 当 9, =0 机 械 手 伸 
直 。 在 这 种 情况 下 ， 末 端 操 作 器 的 运动 仅 可 能 沿 一 个 直角 坐标 方向 (垂直 于 机 械 手 的 方 
向 )， 因 此 此 机 构 失去 了 一 个 自由 度 。 类 似 地 ， 当 9, = 180° 机 械 手 完全 折 共 起 来 ， 手 的 运动 
也 只 能 在 一 个 直角 坐标 方向 ， 而 不 是 两 个 方向 。 这 些 奇 异 点 都 是 工作 空间 边界 奇异 点 ， 因 为 
它们 位 于 操作 机 的 工作 空间 的 边界 上 。 

在 机 器 人 控制 系统 中 应 用 式 (4-73) 的 危险 在 于 ,在 奇异 点 处 雅 可 比 矩 阵 的 逆 不 存在 ， 
这 导致 当 接近 这 个 奇异 点 时 关节 速度 趋向 无 穷 大 。 

在 图 4-24 所 示 二 自由 度 机 械 手 中 ， 它 的 末端 操作 器 沿 xo 轴 以 1. 0m/s 的 速度 运动 。 解 
得 两 关节 速度 为 




















J 
= 人 


152 /2s lis2 


说 明 当 远离 奇异 点 时 关节 速度 是 合理 的 ， 但 当 接 近 一 个 奇异 点 2 =0 时， 机械手 伸 出 
去 ， 关 节 速 度 趋向 无 穷 大 。 

2. 机 器 人 的 奇异 位 形 

奇异 位 形 是 串联 机 器 人 机 构 的 一 个 十 分 重要 的 运动 学 特性 ， 机 器 人 的 运动 受 力 、 控 制 以 
及 精度 方面 的 性 能 都 与 此 位 形 密切 相关 。 

机 絮 人 的 奇异 位 形 大 致 可 分 为 两 类 : 

(1) 边界 奇异 位 形 ” 当 机 器 人 臂 全 部 伸展 开 或 全 部 折 回 时 ， 使 手 部 处 于 机 需 人 工作 空 
间 的 边界 上 或 边界 附近 ， 出 现 逆 雅 可 比 奇异 ， 机 器 人 运动 受到 物理 结构 的 约束 。 

(2) 内 部 奇异 位 形 ” 当 两 个 或 两 个 以 上 关节 轴线 重合 时 ， 机 融 人 各 关节 运动 相互 抵消 ， 
不 产生 操作 运动 。 

对 预定 的 手 部 运动 用 式 (4-73) 可 以 求 出 所 需 控制 的 关节 速度 ;但 是 如 果 雅 可 比 和 矩阵 J 
奇异 ， 即 det(J)= 0， 则 式 (4-73) 的 运算 不 能 成 立 。 由 此 引起 了 对 奇异 位 形 的 重视 。 从 运 
动 学 角度 讲 ， 当 机 器 人 运动 到 奇异 位 形 时 ， 手 部 将 失去 某 个 或 某 些 独立 的 运动 分 量 〈 失 去 
一 个 或 几 个 自由 度 ) ， 因 而 导致 手 部 自由 度 的 减少 ， 这 意味 着 在 直角 坐标 系 空间 有 某 些 方向 
(或 子 空 间 ) ， 无 论 取 什么 样 的 关节 速度 ， 机 顺 人 的 手 都 不 可 能 治 它们 运动 。 显 然 这 种 情况 
会 发 生 在 机 器 人 工作 空间 的 边界 上 ， 无 法 解 出 关节 速度 ， 机 顺 人 处 于 退化 位 置 。 这 不 仅 影响 
手 部 完成 预定 的 运动 ， 也 给 机 带 人 的 控制 带 来 了 困难 。 
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4.5 本 竟 小 结 


本 章 讨论 了 几 种 特定 类 型 机 需 人 的 正 逆 运 动 方程 以 及 欧 拉 角 和 RPY 姿态 角 ， 这 些 特 定 
类 型 机 带 人 包括 直角 坐标 、 圆 柱 坐 标 和 球 坐标 机 带 人 。 本 章 的 主旨 是 学 习 如 何 表 示 多 自由 度 
机 器 人 在 空间 的 运动 ， 以 及 如 何 用 D-H 表示 法 导出 机 带 人 的 正道 运动 学 方程 。 这 种 方法 可 
用 于 表示 任何 一 种 机 器 人 的 构 型 。 

本 章 还 讨论 了 机 器 人 的 雅 可 比 和 矩阵 的 建立 ， 包 插 速 度 雅 可 比 和 力 雅 可 比 。 同 时 对 机 器 人 
奇异 点 和 奇异 位 形 进行 了 分 析 ， 机 器 人 处 于 奇异 位 形 时 ， 会 失去 一 个 或 多 个 和 目 由 度 ， 会 影响 
手 部 完成 预定 运动 ， 同 时 也 会 给 机 器 人 控制 带 来 困难 。 


习 题 




















4-1 如 图 4-29 所 示 二 自由 度 机 械 手 ， 关 节 1 为 转动 
关节 ， 关 节 变 量 为 0; 关节 2 为 移动 关节 ， 关 节 变 
量 d,。 

1) 建立 关节 坐标 系 ， 并 写 出 该 机 械 手 的 运动 方 
程式 。 

2) 按 下 列 关节 变量 参数 ， 求 出 手 部 中 心 的 位 置 值 。 

0 0° 30° 60° 90° 
dy/m 0.50 0. 80 1.00 0.70 图 4-29 二 自由 度 机 械 手 























4-2 ”如 图 4-29 所 示 二 自由 度 机 械 手 ， 已 知 手 部 中 心 坐标 值 为 (x，y)。 求 该 机 械 手 运 
动 方程 的 首 解 0 及 d,。 

4-3 三 自由 度 机 械 手 如 图 4-30 所 示 ， 辟 长 为 1 和 1,， 手 部 中 心 离 手腕 中 心 的 距离 为 
万 ， 转 角 为 9 、0,、03， 试 建立 连 杆 坐标 系 ， 并 推导 出 该 机 械 手 的 运动 学 方程 。 

4-4 图 4-31 所 示 为 二 自由 度 机 械 手 ， 两 连 杆 长 度 均 为 Im， 试 建立 各 连 杆 坐标 系 ， 求 出 
该 机 械 手 的 运动 学 正解 和 逆 解 。 









































图 4-30 三 自 由 度 机 械 手 图 4-31 二 自 | 度 机 械 手 
4-5 ”什么 是 机 器 人 运动 学 逆 解 的 多 重 性 ? 
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4-6 图 4-32 所 示 为 三 自由 度 机 械 手 。 
1) 用 D-H 方法 建立 各 附 体 坐 标 系 。 
2) 列 出 连 杆 的 D-H 参数 表 。 

3) 建立 运动 学 方程 。 

4) 建立 雅 可 比 和 矩阵。 





4-7 图 4-33 所 示 为 三 自由 度 机 械 手 ， 手 部 握 有 焊 
接 工 具 。 已 知 b = 30。，b, = 45°，0,; = 30°，0, = 


0. 04rad/s, 0,=0, 90,=0. lrad/s。 求 焊接 工具 末端 4 


点 的 线 速度 v，v,。 


图 4-33 





4-8 E 知 二 自由 度 机 相手 的 硬 可 比 和 了 为 | 
点 力 =[1 0]" 时 , 求 相应 的 关节 力矩 7。 
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图 4-32 三 自由 度 机 械 手 
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机 器 人 动力 学 





机 融 人 动力 学 主要 是 人 研究 机 带 人 机 构 的 动力 学 。 在 机 器 人 动力 学 的 研究 中 ， 要 解决 的 问 
题 很 多 ， 但 归纳 起 来 主要 有 两 类 : 第 一 类 问题 是 动力 学 的 力 分 析 ， 或 称 为 动力 学 正 问题 ， 它 
是 已 知 关节 的 驱动 力 或 力矩 ， 求 机 器 人 系统 相应 的 运动 参数 ， 包 括 关节 人 位移、 速度 和 加 速 
度 。 第 二 类 问题 是 动力 学 逆 问 题 一 一 已 知 运动 轨迹 点 上 的 关节 位 移 、 速 度 和 加 速度 ， 求 出 相 
应 的 关节 力 或 力矩 。 研 究 机 絮 人 动力 学 的 目的 是 多 方面 的 。 动 力学 正 问 题 对 机 器 人 运动 仿真 
是 非常 有 用 的 ; 动力 学 逆 问 题 对 实现 机 器 人 实时 控制 是 相当 有 用 的 。 利 用 动力 学 模型 ， 实 现 
最 优 控 制 ， 以 期 达到 良好 的 动态 性 能 和 最 优 指标 。 

机 老人 动力 学 模型 主要 用 于 机 咒 人 的 设计 和 离线 编程 。 在 设计 中 需 根据 连 杆 质量 、 运 动 
学 和 动力 学 参数 、 传 动机 构 特征 和 负载 大 小 进行 动态 仿真 ， 对 其 性 能 进行 分 析 ， 从 而 决定 机 
器 人 的 结构 参数 和 传动 方案 ， 验 算 设 计 方 案 的 合理 性 和 可 行 性 。 在 离线 编程 时 ， 为 了 估计 机 
器 人 高 速 运动 引起 的 动 载荷 和 路 径 偏差 ， 要 进行 路 径 控制 仿真 和 动态 模型 的 仿真 。 这 些 都 必 
须 以 机 器 人 动力 学 模型 为 基础 。 机 器 人 是 一 个 非 线性 的 复杂 的 动力 学 系统 。 动 力学 问题 的 求 
解 比较 困难 ， 而 且 需 要 较 长 的 运算 时 间 。 因 此 ， 简 化 求解 过 程 ， 最 大 限度 地 减少 机 器 人 动力 
学 在 线 计算 的 时 间 是 一 个 备 受 关注 的 研究 课题 。 

本 章 将 介绍 机 器 人 的 静 力 学 问题 和 动 力学 问题 以 及 动力 学 建 模 和 仿真 。 为 了 建立 机 器 人 
动力 学 方程 ， 在 此 首先 讨论 机 器 人 运动 的 瞬时 状态 ， 对 其 进行 速度 分 析 和 加 速度 分 析 ， 研 究 
连 杆 的 静 力 平衡 ， 然 后 利用 达 朗 贝尔 原理 ， 将 静 力 学 平衡 条 件 用 于 动力 学 。 


5.1 连 杆 的 速度 和 加 速度 分 析 


点 的 速度 表示 一 般 要 涉及 两 个 坐标 系 : 参考 坐标 系 和 运动 坐标 系 。 因 此 要 指明 速度 是 相 
对 于 哪个 坐标 系 的 运动 所 造成 的 ， 在 哪个 坐标 系 中 来 描述 这 一 速度 。 

例如 ， 连 杆 ;相对 于 参考 坐标 系 10| 的 速度 用 w, 和 表示 ; w; 是 连 杆 坐标 系 | 计 的 
角速度 矢量 , 六 是 1i| 的 原点 线 速 度 矢 量 。 如 果 把 两 个 矢量 在 {i 中 描述 ， 即 
为 'w; 和 'y,。 

为 了 描述 刚体 在 不 同 坐 标 系 中 的 运动 ， 设 有 参考 坐标 系 |4| 和 运动 坐标 系 1B8} 两 坐 
标 系 。|B| 相对 于 |4| 的 位 置 矢量 为 4Ps。， 旋 转 和 矩阵 为 64R。 任 一 点 P 在 两 坐标 系 中 的 描 
述 4P 和 5P 之 间 的 关系 为 
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4P=4Pp + RSP (5-1) 
将 上 式 两 边 对 时 间 求 导 得 
4P=4PA + RSP+HARSP (5-2) 
式 中 《P83P 一 点 P 相 对 于 {4| 和 |B| 的 速度 ， 记 为 4V, 和 3V，; 
4Ps 一 一 |B| 的 原点 相对 于 |4| 的 运动 速度 ， 记 为 Vp，; 
4R- 一 旋转 矩阵 4R 的 导数 。 
5. 1. 1 旋转 矩阵 的 导数 RR(1) 
利用 导数 和 微分 的 定义 ， 即 
ev . AR(i) 
SO A 


由 旋转 变换 的 公式 可 知 ，R(t+At) 总 是 可 以 看 成 为 R(t) 在 时 间 间 隔 At 内 绕 某 轴 天 转 
动 微分 角度 59 而 得 到 的 ， 即 





RCHTAI) -Ri) 
Ai 9) 


R(itAi)= R(k, 60)R(1) (5-4) 
AR(i1)= R(itA1)-R(1)= [R(k, 60) -TR(i)= A(k, 60)R(1) (5-5) 
式 中 ”7 一 一 3x3 的 单位 矩阵 ; 
A(k, 60) 微分 旋转 算 子 。 





利用 旋转 变换 通 式 ， 并 用 微量 80 代替 0， 由 于 sin89=50，cos60=1 可 得 
0 -450 ,60 
A(k, 80)=R(k, 60)-I=| 50 0 -hk,.60 (5-6) 
-hk60 1560 0 
把 上 式 两 端 除 以 Az， 并 取 极 限 ， 定 义 为 角速度 算 子 矩阵 : 








》 一 〇 : 7 
SCo)=| 80 0 上 gl=| wo 0 -ow, (5-7) 
-OO， O， 0 
-0 ko0 0 
相应 的 角速度 矢量 WW 为 
Rat 证 二 
W=|1.0|=|%, |=10 (5-8) 
〇 。 
hk.0 


角速度 算 子 矩阵 S(w) 和 角速度 矢量 W 是 角速度 的 两 种 描述 ， 在 任意 矢 径 PP 处 引起 的 
线 速度 Vp 可 表示 为 
Vp=S(w)P=WxP (5-9) 
由 此 可 得 旋转 矩阵 的 导数 为 
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R(1)=S(w)R=WxR (5-10) 


5. 1.2 刚体 的 速度 和 加 速度 


根据 公式 R(1)=S(w)R=>AR=S(^Ws)4R， 有 
4VYp=4Vp + RSVptS( A Wy)’ RP (5-11) 
将 上 式 两 端 求 导 ， 得 加 速度 4V, 和 ?Vj 之 间 的 关系 : 
4Vp=4V8 + RIV,+2S( Ws) RIVp+S( A Wa) RIP+S(AWa)S( Ws) RP (5-12) 
上 面 两 式 分 别 表示 质点 P 了 在 不 同 坐 标 系 中 运动 速度 和 加 速度 的 转换 公式 ,根据 不 同 的 
情况 ， 该 公式 还 可 人 简化: 
1) 若 14} 固定 不 动 ， 刚 体 与 1B| 固 接 ， 有 


SP=const 2Yp=2Yp=0 





则 
4Vp=4Vp +S( Wa) RP (5-13) 
AVp=AVy +S(AWa) RIP+S(A Ws) S(A Ws) RSP (5-14) 
2) 若 运 动 坐 标 系 1B| 相对 于 参考 坐标 系 14} 移动 ， 即 6R 固定 不 变 ， 有 
“Wp=“Wnw =0 
则 
Vp=4Vg + RIV, (5-15) 
AVp=AVa +4RSV, (5-16) 
3) 若 1B| 相对 于 14| 纯 滚动 ， 有 
4Pp, =const 4 Vs, =4V, =0 
则 


MVp= RIVp+S(A Ws) RIP (5-17) 

AVp=ARIV,+2S (AWa) RIVI+S( Ws) RIP+S(AWa)S(Ws) RP (5-18) 

其 中 ,4Ws 表示 坐标 系 1B 相对 于 14} 转动 的 角速度 矢量 。 

若 已 知 1C} 相对 于 1B| 的 转动 角速度 矢量 为 *W-， 则 |C| 相对 于 |4| 的 转动 角 
速度 和 角 加 速度 矢量 为 








AWe= “Wat+s R? Wo (5-19) 
Wo = Wat RI WoetS( Ws) RS Wo (5-20) 
5. 1.3 旋转 关节 的 连 杆 运动 传递 


连 杆 运动 通常 是 用 连 杆 坐标 系 原点 速度 和 加 速度 ， 以 及 连 杆 坐标 系 的 角速度 和 角 加 速度 
来 表示 的 。 旋 转 关 节 的 连 杆 运动 如 图 5-1 所 示 。y; 和 w; 分 别 表示 连 杆 坐标 系 | 让 相对 于 参 
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考 坐 标 系 10} 的 线 速度 和 角速度 ， 

而 ww 和 '*ow; 表示 在 坐标 系 | 计 中 的 线 Mn 
速度 和 角速度 。 7 和 ”oj 表示 在 连 
杆 坐 标 系 |i+1) 中 的 线 速 度 和 角速度 。 
连 杆 it1 相对 连 杆 i 转动 的 角速度 

是 绕 关节 i+1 运动 引起 的 。 

0 
Dial a , (5-21) 

yn 


了 


式 中 0， i 
2 示 系 1i+1) 的 z 轴 单位 矢量 。 
因为 同一 坐标 系 中 的 矢量 可 相 加 ， 因 此 ， 连 杆 i+1 的 角速度 等 于 连 杆 i 的 角速度 加 上 连 
杆 i+1 的 角速度 加 上 连 杆 i+1 绕 关 节 i+1 旋转 的 角速度 ， 在 坐标 系 | 计 中 的 表示 为 


Ji+l 


Xitl 








图 5-1 旋转 关节 的 连 杆 运动 


i+1 

















oo | = "0, ,+ RO 过 1 (5-22) 
将 此 式 两 端 左 乘 旋转 和 矩阵” 及， i 车 杆 本 里 坐标 系 |i+1| 的 表示 : 
Hw = Riw,+0 "zi (5-23) 
坐标 系 |i+1| 原点 的 线 速度 等 于 坐标 系 四 原点 的 线 速度 加 上 连 杆 i 的 转动 速度 产生 
的 分 量 。'p;,1 表 示 坐 标 系 |i+1| 的 原点 在 坐标 系 1 让 中 的 位 置 撩 量 ， 此 位 置 矢量 是 不 变 的 ， 
因此 
Vi = Vit ;Xpinl (5-24) 
上 式 两 端 都 左 乘 "RR， 则 得 到 相对 坐标 系 |i+1| 的 表示 : 
pin =" R(tio Xipin) (5-25) 


由 式 (5-23) 和 式 (5-25) 可 以 得 到 从 一 连 杆 向 下 一 连 杆 的 角 加 速度 和 线 加 速度 传递 
公式 : 
ia -1R + Ri@, x0,, 区 0 2 (5-26) 


itl, itl 


RL Hi Xp tO, x (iew,xip,, ) ] (5-27) 
5. 1.4 移动 关节 的 连 杆 运动 传递 


当 关 节 i+1 是 移动 关节 时 ， 连 杆 i+1 相对 坐标 系 |i+1| 的 z 轴 移动 ， 没有 转动 ,“R 是 
常数 矩阵 ， 相 应 的 运动 传递 关系 为 





六 aol1= “Riai (5-28) 

y= R(tio, Xipi) td lz (5-29) 

Hi = Riw, (5-30) 

3 Wi = RL'y ,txipi tiwix( ‘WiX'pis) ] +2i@wxdi eit d 人 
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5. 1.5 质心 的 速度 和 加 速度 


将 关节 i+1 坐标 原点 处 的 平移 速度 转化 到 质心 处 的 速度 为 
Va= it OX po (5-32) 
将 上 式 对 时 间 求 导 得 质心 处 的 平移 加 速度 


计 寺 





v, ,= +i,xip, ,+0,X( 0w,x'p,,) (5-33) 
其 中 ,质心 坐标 系 1c;| 与 连接 杆 i 固 接 ; 坐标 原点 位 于 连 杆 i 的 质心 ， 坐 标 方向 与 
同 向 。 上 式 中 不 含 关 节 运 动 ， 因 此 不 论 关 节 i+1 是 转动 还 是 移动 都 同样 适用 。 
人 Y 式 ， 利 用 这 些 公 式 可 得 到 从 基 座 开始 传递 的 各 连 
杆 的 '@w;,'y;,'w@; 和 We 作为 递 推 的 初始 ( 基 座 )"wo = oa =0,00 =0v =0， 这 样 递 推 得 到 的 
连 杆 速 度 、 角速度 、 加 速度 和 角 加 速度 都 是 相对 于 连 杆 本 身 坐 标 系 表示 的 。 如 果 将 这 些 
和 角速度 相对 于 基 坐 标 系 10} 表示 ， 则 需 左 乘 旋 转 和 矩阵 ,R， 即 

w=° Riw,, 0y,=° Ry, (i=1,2,.…,n) (5-34) 


5. 1.6 雅 可 比 和 矩阵 的 速度 递 推 法 


逐次 运用 上 面 所 介绍 的 递 推 公式 ， 即 可 求 出 末端 连 杆 的 角速度 "w,, 和 线 速 度 "», ， 根 据 

式 (5-34) 可 得 到 末端 速度 在 基 坐 标 系 中 的 表示 为 "w, 和 %w, ， 简 写 为 w, ，v,。 构 造 末 端 连 
杆 的 笛 卡 儿 广 义 速 度 为 

| | (5-35) 


它 与 关节 速度 g 之 间 的 关系 就 是 由 雅 可 比 组 成 的 线性 映射 : 


x,=J,(g)g (5-36) 
例 5-1 用 递 推 法 求 图 4-28 所 示 二 自由 度 机 械 手 未 端 连 杆 的 速度 和 角速度 以 及 雅 可 比 矩 
阵 。 坐 标 系 12| 固 接 在 手臂 未 端 ， 即 有 0,=0，0,=0。 
解 : 各 连 杆 变换 为 





广 。 






































co0! -s0, 0 0 co, -s0, 0 1) 
os,_|s0 co 0 0 1,_|s0, co 0 0 
rr jo 0 10| ”|o 0 10 
0 0 01 0 0 01 
[1 0 0 
0 10 0 
A 0 .010 
[0 00 1 
根据 式 (5-23)、 式 (5-25) 依次 算出 各 连接 杆 的 速度 和 角速度 。 


基 坐 标 系 10| 固定 不 动 ， 则 "wo=0,"vo=0。 其 余 各 连 杆 的 速度 和 角速度 为 
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0 0 0 
omw， = 0 Di=|0| 2,= 0 
0) 01+0, 
c» -s» 0 0 Li l1ss01 
2y,=|s C 0 0 X| 0 | = 
2 2 2 lics01 
0 0 1 01 0 
3 = 0, 
1 0 0 lis201 0 /2 lis201 
Ba 3 0 ES a 
El lics01 a i lics01+l, (01+0,) 
0 0 1 0 +0 0 
0 5 0 
1,s,0 1s, 0190 
因为 152 2 人 | . 
lics01+l, (01+0) Le 02 
号 11s> 0 
、 J Et 
(9 


为 了 求 出 相对 于 基 坐 标 系 10| 表示 的 "ws 和 "vs ， 计 算 旋转 变换 ; 

cy -3S2 0 

SR="RIRR=|s co 0 

0 0 1 

0 
0%, =0R3m = 
2 3 
01+0, 
-lis101-Llss1» (01+0,) 


0 -0p3, = 5 Se 
ee lici01-lsc1s (01+0,) 








0 
末端 连 杆 的 备 卡 儿 广义 速度 为 
V3x | =is1—l2s1, -lys12 
3y licitlacs lzc1 
V3 V3 0 0 01 
V3 = = 
3 3x 0 0 0， 
CO3y 0 0 
po 痢 1 
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于 是 机 械 手 的 雅 可 比 为 
| -11s1-2s1 -02s12 
Aicl+l2ciz /cl 
0 0 
"J(g)= 
0 0 
0 0 
| 1 1 
可 简写 成 
-151-12si7 ~l2s12 
J=| ci+pcp lc 





1 1 








由 此 可 知 与 第 4 章 所 求 得 的 结果 是 一 样 的 。 


5.2 机 器 人 项 力学 分 析 


5.2.1 连 杆 静 力学 分 析 


在 对 操作 臂 进行 静 力学 分 析 时 ， 首 先 考 
虑 其 中 的 一 个 连 杆 i， 建 立 连 杆 i 的 力 和 力 
和 矩 平 衡 方程 。 如 图 5-2 所 示 ， 杆 件 i 通 过关 
节 和 计 工 分 别 与 杆 件 i-1 和 杆 件 i+1 相连 
接 ， 两 个 坐标 系 1i-1) 和 {i 分 别 如 图 
5-2 所 示 。 























图 中 fin 一 i-1 杆 通 过 关节 i 区 
作用 在 i 杆 上 的 力 
和 力矩 ; 图 5-2 杆 件 i 上 的 力 和 力 算 
洲 in 一 i 杆 通 过 关节 i+1 作用 在 i+1 杆 上 的 力 和 力矩 ; 


一 fl1、-nin 一 一 i+1 杆 通过 关节 i+1 作用 在 i 杆 上 的 反作用 力 和 反作用 力 甜 ; 
"fv na 一 一 机 絮 人 手 部 端点 对 外 界 环境 的 作用 力 和 力矩 ; 
一 所 i -al 一 一 外 界 环境 对 机 器 人 手 部 端点 的 作用 力 和 力矩; 
"fi 一 一 机 器 人 底座 对 杆 1 的 作用 力 和 力矩 ; 
mig 一 一 连 杆 i 的 重量 ,作用 在 质心 C; 上 。 
连 杆 i 的 静 力 学 平衡 条 件 为 其 上 所 受 的 合力 和 合力 和 矩 为 零 ， 因 此 力 和 力矩 平衡 方程 
式 为 














Tfit( fi) tmig=0 (5-37) 
Tni+t( -i J Tp,+t'pe) x™ f+( -psi) x( = fa )=0 (5-38) 
式 中 1p， 坐标 系 | 计 的 原点 相对 于 坐标 系 (i-1| 的 位 置 矢量 ; 
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is 一 一 质心 相对 于 坐标 系 1i} 的 位 置 矢量 。 
在 此 ， 暂 时 忽略 连 杆 本 身 的 自重 ， 从 末端 连 杆 逐次 向 基 座 〈 连 杆 0) 反 向 递 推 各 连 杆 所 
受 的 力 和 力矩 : 








fi= "fi (5-39) 
R= nt pix™ ff (5-40) 
利用 旋转 变换 矩阵 , '*R， 将 上 式 右 端的 力 和 力矩 写成 在 自身 坐标 系 中 的 表示 : 
f= Rif (5-41) 
RsI+ pix™ ff, (5-42) 


为 了 便于 表示 机 带 人 和 手 部 端点 对 外 界 环境 的 作用 力 和 力矩 (简称 为 端点 力 F)， 可 
将 "fi 和 "ny 合并 写成 一 个 6 维 矢量 ， 即 


bo 
F= (5-43) 


n 
LU 








各 关节 驱动 絮 的 驱动 力 或 力矩 可 写成 一 个 n 维 矢 量 的 形式 ， 即 


T= (5-44) 


式 中 nn 一 一 关节 的 个 数 ，; 
7 一 一 关节 力矩 (或 关 方 力 ) 矢量 ,简称 广义 关节 力矩 ， 对 于 转动 天方 ，7; 表示 关节 
了 驱动 力矩 ， 对 于 移动 关节 ，7; 表示 关节 驱动 力 。 
接 下 来 计算 每 个 天方 的 驱动 力 或 力矩 。 其 实 各 个 连 杆 所 承受 的 力 矢量 和 力矩 矢量 中 ， 茶 
些 分 量 由 操作 臂 本 身 的 连 杆 结构 所 平衡 ， 一 部 分 分 量 则 为 各 关节 的 驱动 力 或 驱动 力矩 所 
平衡 。 
对 于 转动 和 关节， 关节 驱动 力矩 平衡 力矩 的 z 分 量 为 























T= i (5-45) 
对 于 移动 关节 ， 关 节 驱 动力 平衡 力 的 z 分 量 为 
7,=71f iz, (5-46) 


了 


5.2.2 机 器 人 静 力学 的 两 类 问题 


从 操作 臂 手 部 端点 力 下 与 广义 关节 力矩 之 间 的 关系 式 r=.1 下 可知， 操作 臂 静态 学 可 
分 为 两 类 问题 : 

1) 已 知 外 界 环境 对 机 右 人 手 部 作用 力 F'( 即 手 部 端点 力 F=-F')， 求 相应 的 满足 静 力 
学 平衡 条 件 的 关节 驱动 力矩 7。 

2) 已 知 关节 驱动 力矩 7， 确 定 机 器 人 手 部 对 外 界 环境 的 作用 力 环 或 负荷 的 质量 。 

第 二 类 问题 是 第 一 类 问题 的 逆 解 。 这 时 

下 =(.J)-17 
但 是 ， 由 于 机 器 人 的 自由 度 可 能 不 是 6， 如 nz>6， 力 雅 可 比 和 矩阵 就 有 可 能 不 是 一 个 方 
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阵 ， 则 六 就 没有 逆 解 。 所 以 ， 对 这 类 问题 
的 求解 就 困难 得 多 ， 在 一 般 情 况 下 不 一 定 
能 得 到 唯一 的 解 。 如 果 的 维 数 比 r 的 维 
数 低 ， 且 了 是 满 秩 的 话 ， 则 可 利用 最 小 二 
乘法 求 得 的 佑 值 。 

例 5-2 如 图 5-3 所 示 的 一 个 二 自由 度 
平面 关节 型 机 械 手 , 已 知 手 部 端点 力 = 
[FF,]*， 求 相应 于 端点 力 忆 的 关节 力矩 
(不 考虑 摩擦 ) 。 

解 : 已 知 该 机 械 手 的 速度 雅 可 比 为 

攻 -lss(01+0,) -lss(01+0,) 

| hcOithe(0+0,) Lc(01+0,) 

则 该 机 械 手 的 力 雅 可 比 为 





FAR, Py] 














a) b) 


图 5-3” 手 部 端点 力 与 关节 力 和 矩 7 





al se (01+0,) {ici tle > 


-ls (01+0,) lc (01+0,) 
根据 r=. 太 及， 得 


间 
T= 三 


-ls (01+0,) be (01+0,) LF, 





所 以 
T1 =—(lsitlsi PF, +( licithc) PF, 
7T2= -sh thc 
如 图 5-3b 所 示 ， 若 在 某 瞬 时 9, =0，0 =90"， 则 在 该 瞬时 与 手 部 端点 力 相 对 应 的 关节 力 
和 矩 为 





T1=-bP th PF,, 7 =-lP, 


5.3 牛顿 一 欧 拉 递 推动 力学 方程 














机 器 人 动力 学 的 研究 方法 很 多 ， 所 采用 的 方法 有 : 牛顿 - 欧 拉 方法 、 拉 格 朗 日 法 、 高 共 
法 、 凯 恩 法 和 旋 量 对 偶数 方法 等 。 现 介绍 牛顿 - 欧 拉 方法 ， 利 用 运动 (速度 和 加 速度 ) 递 推 
和 力 的 递 推 来 建立 机 器 人 动力 学 方程 ， 讨 论 动力 学 问题 的 求解 方法 。 

5. 3. 1 牛顿 一 欧 拉 方程 

牛顿 一 欧 拉 方 程 法 (也 简称 为 N-E 法 ) 是 用 构件 质心 的 平 动 和 相对 质心 的 转动 表示 机 
器 人 构件 的 运动 ， 利 用 动静 法 建立 基于 牛顿 - 欧 拉 方 程 的 动力 学 方程 。 研 究 构 件 质心 的 运动 
使 用 牛顿 方程 ， 研 究 相 对 于 构件 质心 的 转动 使 用 欧 拉 方 程 。 欧 拉 方 程 表征 了 力 、 力 和 矩 、 惯 性 
张 量 和 加 速度 之 间 的 关系 。 

如 果 将 操作 臂 的 连 杆 i 看 成 刚体 ， 它 的 质心 加 速度 vy ,;、 总 质量 m; 与 产生 这 一 加 速度 的 
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作用 力 f; 之 间 的 关系 满足 牛顿 第 二 运动 定律 : 
fi=miv (5-47) 
当 刚 体 绕 过 质心 的 轴线 旋转 时 ， 角 速度 wm; 、 角 加 速度 w;、 人 惯性 张 量 I,， 与 作用 力矩 n， 
之 间 满 足 欧 拉 方程 : 
n;=1,0,+0,x( 1,0,) (5-48) 
称 式 (5-47) 为 牛顿 方程 ， 式 (5-48) 为 欧 拉 方程 。 其 中 五 为 杆 i 绕 其 质心 的 惯性 张 量 。 
在 以 上 两 定理 中 ， 牛 顿 定理 描述 随 质 心 的 平 动 ， 欧 拉 定 理 描述 绕 质 心 的 转动 。 
所 以 ,机 器 人 的 牛顿 一 欧 拉 定理 描述 为 
f+-ifi) tmig—miva=0 (5-49) 
Tt- nn ) + poxX, 1 pax f+ x( Ti0;)= 0 (5-50) 
上 面 推导 的 牛顿 一 欧 拉 法 方程 式 含 关节 连接 的 约束 力 (和 矩 ), 没有 显 式 地 表示 输入 一 输 
出 关系 ， 不 适合 进行 动力 学 分 析 和 控制 器 设计 。 若 变换 成 由 一 组 完备 且 独 立 的 位 置 变量 
(质心 位 置 变 量 通 常 不 是 相互 独立 的 ) 和 输入 力 来 描述 ， 这 些 变量 都 显 式 地 出 现在 动力 学 方 
程 中 ， 即 得 到 显 式 的 输入 一 输出 形式 表示 的 动力 学 方程 ， 称 为 封闭 形式 的 动力 学 方程 ( 拉 
格 朗 日 方程 即 是 封闭 的 ) 。 关节 变量 g 是 一 组 完备 且 独 立 的 变量 ,关节 力 (和 矩 ) 7+ 是 一 组 从 
约束 力 〈 和 矩 ) 中 分 解 出 来 的 独立 的 输入 ， 所 以 用 gq 和 来 描述 方程 可 以 得 到 封闭 形式 的 
动力 学 方程 。N-E 法 常用 的 不 是 它 的 封闭 形式 方程 ， 而 是 它 的 弟 推 形式 方程 。 


5. 3. 2 惯性 张 量 


令 1C} 是 以 刚体 的 质心 C 为 原点 规定 的 一 个 坐标 系 ， 相 对 于 该 坐标 系 | C} ， 惯 性 张 
量 氏 定义 为 3x3 的 对 称 矩 阵 ; 










































































le 一 xy 一 人 
区 全 (5-51) 
jh 
其 中 ， 对 角 线 元 素 是 刚体 绕 三 坐标 轴 x，y，z 的 质量 惯性 矩 : 
I =| (2422)pdo， 1, -= (x2+z2)pdo, L =) Cary i (5-52) 


其 余 元 素 为 惯性 积 ， 
t= pao, 10= | pa, 1.= Ba (5-53) 


其 中 ， p 为 密度 ; du 是 微分 体 元 ， 其 位 置 由 矢量 p=[x y z]' 确定 。 

惯性 张 量 1 表示 刚体 质量 分 布 的 特征 ， 其 值 与 选取 的 参考 坐标 有 关 ， 如 果 所 选 的 坐标 
系 1C| 的 方位 使 各 惯性 积 工 ,有 ,和 工 , 均 为 零 ， 惯性 张 量 变 成 对 角 型 ， 则 此 坐标 的 各 轴 称 
为 惯性 主轴 ， 相 应 的 质量 惯 性 算 称 为 主 惯 性 矩 。 

0 | 与 质心 坐标 系 1C| 平行 ,根据 平行 轴 定 理 ， 刚 体 相 对 两 平行 坐标 系 的 
惯性 矩 和 惯性 积存 在 以 下 关系 : 








“1 = Hey 
es (5-54) 
“7 =°1, tm( x +y, ) 


112 


第 5 章 “机 器 人 动力 学 | 








其 中 ，x。，y。，z。 是 质心 C 在 坐标 系 14} 中 的 三 个 分 量 ， 其 他 惯性 矩 和 惯性 积 的 转换 
公式 类 似 。 

除 此 以 外 ， 刚 体 的 惯性 张 量 还 有 以 下 几 条 常用 的 性 质 : 

1) 对 于 有 对 称 面 的 刚体 ， 带 有 与 对 称 面 垂直 的 轴 的 下 标的 惯性 积 为 零 。 

2) 惯性 矩 总 是 为 正 ， 而 惯性 积 可 以 是 正 ， 也 可 以 是 负 。 

3) 只 改变 体 坐 标 系 的 方向 时 ， 三 个 惯性 矩 的 总 和 不 变 。 
4) 惯性 张 量 矩 阵 的 特征 值 是 刚体 的 惯性 主 矩 ， 特 征 矢量 的 方向 就 是 惯性 轴 的 方向 。 

在 机 器 人 的 机 构 中 ， 构 件 的 几何 形状 及 其 组 成 都 比较 复杂 ， 计 算 每 个 构件 的 惯性 矩 是 非 
常 困难 的 ， 因 此 实际 应 用 中 是 用 惯量 摆 等 仪器 实测 而 得 的 。 


5. 3.3 ”动力 学 逆 问 题 的 递 推算 法 


利用 质心 运动 变量 与 关节 变量 及 关节 运动 变量 之 间 的 关系 以 及 约束 力 与 关节 力矩 之 间 的 
关系 ， 消 去 中 间 变 量 ， 可 以 得 到 封闭 形式 的 动力 学 方程 。 但 不 如 用 拉 格 于 日 法 简单 ， 特 别 是 


















































当 机 器 人 自由 度 较 多 时 ， 更 是 如 此 。 因 此 ，N-E 法 常用 的 不 是 它 的 封闭 形式 方程 ， 而 是 它 的 


递 推 形式 方程 。 动 力学 道 问题 是 根据 关节 位 移 、 速 度 和 加 速度 0，6，0 求 所 需 的 关节 力矩 
或 力 7。 整 个 算法 由 两 部 分 组 成 . 
1) 向 外 递 推 计算 各 连 杆 的 速度 和 加 速度 ， 由 牛顿 一 欧 拉 公式 算出 各 连 杆 的 惯性 力 和 
力矩 。 
2) 向 内 递 推 计算 各 连 杆 相互 作用 的 力 和 力矩 ， 关节 驱 动力 或 力矩 。 
向 外 递 推 (i. 0 一 n-1) 

















IR .iw,+0i1"1zisl (对 于 转动 关节 i+1) 











w= (5-55) 
i A 
Rw; (对 于 移动 关节 i+1) 
"IR N iwt" R > iw,x0,, itlz +0,, a (转动 关节 ) 
on . (5-56) 
7 十 二 一 上 人 
Re (移动 关节 ) 
RE to Xipa tO X( wxipin ) ] (转动 关节 ) 
ee RLV ,to,Xipi te Xx( ‘WiX'pin ) ] (5-57) 
a (移动 关节 ) 
+2 0 Xd Zit di” Zirl 
a V (it1) = Fynt il xi pur) + X( oil xp ) (5-58) 
fir1)= mi Vit1) (5-59) 
Tacp= TD Ot wx(Tc)" iri) (5-60) 
向 内 递 推 ( 7 一 1) 
万 = RAT+ 太 (5-61) 
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in=, Rn tinatipaXi fatipiaX, Rf (5-62) 
i “1z, (转动 关节 ) 
二 (5-63) 
:1 . iz。 (移动 关节 ) 
例 5-3 如 图 5-4 所 示 , 一 个 二 自由 度 平面 机 械 
手 , 假定 两 个 连 杆 的 质量 集中 在 连 杆 末端 ， 分别 为 
mi 和 ma。 用 牛顿 一 欧 拉 法 求 动力 学 方程 ， 并 用 关 
节 变 量 9,，0, 和 关节 力矩 7,/，7, 表示 封闭 动态 
方程 。 
已 知 机 械 手 的 运动 学 参数 和 动力 学 参数 为 
两 连 杆 质心 和 撩 径 : pi =lix1, pw =l2x 


基 座 固定 ; oo=0，mo=0 

相对 质心 的 惯性 张 量 ; 1 =1=0 
未 端 操 作 器 : f=0，ns=0 

解 ; 连 杆 间 的 旋转 变换 矩阵 为 











图 5-4 二 自由 度 平面 机 械 手 示意 图 

















cl -s! 0 c» -s» 0 
"R= s1 cl 0 ,R= s» Cc 0 
0 0 1 0 0 1 
1) 问 外 递 推 计 算 各 连 杆 的 速度 和 加 速度 ， 由 牛顿 一 欧 拉 公式 算出 各 连 杆 的 惯性 力 和 
力矩 。 
对 于 连 杆 1: 
0 0 
1=0 z= 8 wl=01 zi= 
0 0 
[oa s1 0lro 851 
yi1= -s1 cl Ollg|=|gc 
[0 0 1JL0 0 
851 0 | ma | 0 | 0 Ll gs1-l101 
ly=| gc |+ xlol+ 0 lx 0 lxlo 册 
: gcitl1 01 
0 01| L0 0) 0) 0 
= 0 
gs1-1107 0 
WE 1 
fai=m v=m gci+li 0 | 11 0 
0 
上 0 
对 于 连 杆 2: 
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0 0 
20, = 0 20, = 0 
01+0, 01+0, 
c» ss» 0 gs1-1107 poral 0 09+l 01s, 
| 3 es : 
v=|-s» c, 0 gci+li 0 gci2+l1 07s2 + 01c;» 
0 0 1 
| 0 0 
| 0 区 入 01+0,)? gs12 -11017c2+11 0 1s» 
py RE 
Val 01+0,) | 0 gci2+l1 O01s2+h 0 1c2 
0 | 0 0 





gs12-l1 07c2 + 0 1s2-ls( 01+0,)7 0 
2 Se a 2 
foam gci2+tl1 O12+l G1ctls( 01+0,) | 站 


0 
2) 向 内 递 推 计算 各 连 杆 相互 作用 的 力 和 力矩 ， 关 节 驱 动力 和 力矩 。 
对 于 连 杆 2: 





万 = 
0 
0 


2 
到 2? 二 


malil2cs b 1+na0ilsa02+maDegcia+maE2( 9 1 十 b 2 ) 


对 于 连 杆 1: 

c» -s» 0]1|m20s2 0 1—m2lic2 01 -m2l2( 01+0,)? +m2ags12 —mili O01+tmigsi 
lp 区 see 
| malics 0 1—m2alis20° mal,( 01+ 0,) t+m,gc1 mili1 0 ?+migcl 

0 0 1 

0 0 
| 0 
pn) = 0 型 


| malil2c2 9 1t+m2l,( 9 i 9 2) tmalilysy 9? +malgen ml 9 1tmilige 


| 0 
0 





| ze 0 1+tmlibycs 01+0,)-m,lil,s,( 01+0,) +m,ligc 
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最 后 ， 将 'n, 和 ?n, 的 = 轴 分 量 列 出 ， 即 得 到 两 关节 力矩 ; 


Tl =m202( 0 1 十 0 2) tmzlilscs( 2 0 1 十 0 2) +(mitm2) 0 1—mol11l2s2 02 


+2moli ls2 01 Otmabgcnt( mitms )lige 


T2? =molilsc, 0 1+m2l( 0 1 二 0 > ) tmolilysy07 tmalsge 
此 为 关节 驱动 力矩 作为 关节 位 移 、 速 度 和 加 速度 的 显 函 数 表达 式 ， 即 为 二 自由 度 平面 机 
械 手 动力 学 方程 的 封闭 形式 。 


s.4 关节 空间 和 操作 空间 动力 学 


1. 关节 空间 和 操作 空间 

n 个 自由 度 操作 臂 的 手 部 位 姿 卫 由 个 关节 变量 所 决定 ， 这 个 关节 变量 也 称 为 维 关 
节 矢 量 g， 所 有 关节 矢量 g 构成 了 关节 空间 。 操 作 辟 在 工作 过 程 中 ， 末 端 手 部 的 作业 是 在 直 
角 华 标 空间 中 进行 的 ， 即 操作 臂 手 部 位 姿 又 是 在 直角 坐标 空间 中 描述 的 ， 因 此 把 这 个 空间 称 
为 操作 空间 。 运 动 学 方程 =X(g) 就 是 关节 空间 向 操作 空间 的 映射 ;而 运动 学 道 解 则 是 由 
映射 求 其 在 关节 空间 中 的 原 像 。 在 关节 空间 和 操作 空间 中 操作 辟 动 力学 方程 有 不 同 的 表示 形 
式 ， 并 且 两 者 之 间 存在 着 一 定 的 对 应 关系 。 

2. 关节 空间 动力 学 方程 

以 二 自由 度 机 器 人 为 例 ， 说 明 机 器 人 动力 学 方程 的 建立 过 程 。 将 二 自由 度 平面 机 械 手动 
力学 方程 的 封闭 形式 写成 矩阵 形式 ， 则 

7=D(g) g +H(g,g)+G(g) (5-64) 


T] Ol > 0 寺 0 
中 : | [a J: | i 
2 02 0 0, 
























































所 以 
mip? tma( 1? +p;+211p2cos0, ) ma( p+lip2cos0, ) 

p(g)= (5-65) 

m,(p; +lip2c0s0, ) m2p, 

. 02+201 0， 
H(g,q)= mlip,sing, sy (5-66) 
0 

(mpitm2li ) gsin01 tmpsgsin( O11+0, ) 

C(C9)= | . (5-67) 
mpsgsin( 01+0, ) 


式 (5-64) 就 是 操作 臂 在 关节 空间 中 的 动力 学 方程 的 一 般 结构 形式 ， 它 反映 了 关节 力矩 
与 关节 变量 、 速 度 、 加 速度 之 间 的 函数 关系 。 对 于 个 关节 的 操作 辟 ，D(gq) 是 nxn 的 正定 
对 称 和 矩阵 ， 是 9 的 函数 ， 称 为 操作 辟 的 惯性 矩阵 ; 五 (gq,，g ) 是 nxl 的 离心 力 和 哥 氏 力 矢 
量 ; G(q) 是 nxl 的 重力 矢量 ,与 操作 臂 的 形 位 有 关 。 

3. 操作 空间 动力 学 方程 

与 关节 空间 动力 学 方程 相对 应 ， 在 笛 卡 儿 操作 空间 中 ， 可 以 用 直角 坐标 变量 即 手 部 位 姿 
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的 矢量 马 来 表 示 机 器 人 动力 学 方程 。 因 此 ， 操 作 力 与 手 部 加 速度 羡 之 间 的 关系 可 表 
示 为 

F=M,(g) X+U,(g,9)+G,(g) (5-68) 

其 中 ,，M.(g)、U.(g，g) 和 G,(g) 分 别 为 操作 空间 中 的 惯性 矩阵 、 离 心力 和 哥 氏 力 矢量 、 

重力 矢量 ， 它 们 都 是 在 操作 空间 中 表示 的 ; F 是 广义 操作 力 矢量 。 

关节 空间 动力 学 方程 和 操作 空间 动力 学 方程 之 间 的 对 应 关系 可 以 通过 广义 操作 力 

不 与 广义 关节 力矩 之 间 的 关系 和 操作 空间 与 关节 空间 之 间 的 速度 、 加 速度 的 关系 
求 出 。 

7=J "(gqg)F (5-69) 


¥=J(gq)g 
X=J(g) 9g+](g)g 
4. 操作 运动 一 一 关节 力矩 方程 
机 器 人 动力 学 最 终 是 研究 其 关节 输入 力矩 与 其 输出 的 操作 空间 之 间 的 关系 。 由 式 
(5-68) 和 式 (5-69) 可 见 ， 两 者 之 间 的 关系 为 


(5-70) 


7=J"[M,.(g) * +U,(g,q)+G.(gq)] (5-71) 
7=J'V(g) x +B.(g)[g gj+C.(qg)l gq’”]+G(g) (5-72) 
其 中 ， [g gq] = [gq192 0193 re gn19n] 是 n(n-1)/2 维 的 关节 速度 积 矢量 ; [q”] = 





[4? 9 … 4] 是 n 维 关节 速度 平方 矢量， B(gq) 是 哥 氏 力 的 系数 矩阵 ，n(n-1)/2 阶 
和 矩阵; C(g) 是 nxn 阶 的 离心 力 系数 矩阵 。 然 而， 在 一 般 情况 下 B(g)zB(g), C,(q)#C 
(gq)。 


5.5 动力 学 性 能 指标 


实际 上 ， 机 器 人 不 仅 在 奇异 点 处 完全 丧失 了 一 个 或 多 个 自由 度 ， 在 奇异 点 附近 ， 其 动力 
学 性 能 也 会 变 坏 。 机 右 人 的 动力 学 性 能 与 这 些 度量 指标 也 有 一 定 的 联系 ,一 般 情况 下 ， 离 奇 
异 点 越 远 ， 则 机 器 人 在 各 个 方向 的 动力 学 性 能 和 施 力 效果 的 一 致 性 越 好 。 

机 器 人 动力 学 十 分 复杂 ， 如 何 评定 它 的 动力 学 性 能 ， 对 于 开发 高 精密 机 器 人 以 及 机 器 人 
结构 设计 、 工 作 空间 的 选择 、 轨 迹 规 划 和 控制 方案 的 拟定 都 具有 重要 的 作用 。H. Asada 利用 
广义 惯性 椭 球 GIE 来 评定 机 器 人 的 动力 学 特征 ， 用 于 机 器 人 的 工作 空间 分 析 ， 几 何 上 明显 
直观 。Yoshikawa 基于 可 操作 性 指标 w=vVdet[ J(g)J "(gq)] ， 又 提出 动态 可 操作 性 椭 球 DME 
来 衡量 机 器 人 动力 学 的 操作 能 力 。Khatib 和 Burdick 以 变换 矩阵 的 形式 建立 了 关节 力矩 与 操 
作 空 间 中 的 加 速度 之 间 的 输入 输出 关系 ,定义 一 种 代价 函数 衡量 在 工作 空间 中 动态 性 能 与 设 
计 变 量 (机 器 人 结构 参数 ) 之 间 的 关系 。 

机 器 人 动力 学 的 复杂 性 不 仅 在 于 结构 的 复杂 性 ， 还 由 于 作业 情况 的 多 样 性 和 影响 因素 的 
可 变性 。 在 机 器 人 的 设计 、 轨 迹 控制 时 ， 应 该 注意 的 是 某 些 极限 或 最 危险 的 情况 ， 如 最 大 加 
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速度 时 ， 最 高 速度 作业 时 ， 悬 伸 最 长 、 不 平衡 最 大 时 等 ， 应 该 考虑 这 些 最 坏 情况 下 的 作业 情 
况 和 对 动力 学 的 要 求 。 因 此 ， 提 出 了 衡量 机 器 人 动力 学 性 能 的 高 速 性 能 指标 PIV、 加 速 性 能 
指标 PIA 和 综合 性 能 指标 PIC 及 相应 的 优化 方法 。 为 了 说 明 各 种 动力 学 性 能 指标 之 间 的 联 
系 ， 本 节 首 先 考 虑 关节 空间 和 操作 空间 中 的 加 速度 与 作用 力 之 间 的 联系 ， 然 后 讨论 广义 惯性 
椭 球 GIE 和 动态 可 操作 性 椭 球 DME， 紧 接着 介绍 三 个 动力 学 性 能 指标 。 

1. 加 速效 果 

为 了 对 操作 臂 进行 加 速度 分 析 ， 令 在 动力 学 方程 式 (5-64)、 式 (5-68) 和 式 (5-71) 
中 的 g=0。 为 便于 分 析 ， 不 考虑 重力 的 影响 ， 因 而 关节 驱动 力 和 操作 力 均 由 惯性 力 平衡 ， 
分 别 标记 为 +7, 和,。 这 时 ， 作 用 力 与 相应 的 加 速度 之 间 的 关系 (加 速效 果 ) 为 
gq =D 1(g)7, 
gqg =D (gqg) Tq)F,=1(g)F, 
x =J(g)D (gqg)7,=E(g)7, 


x=J(g)D (gq) Tq PF, =V (qr, 

矩阵 Di(g), I(g),， El(q) 和 V1'(gq) 具有 不 同 的 量 纲 ， 从 不 同 侧面 表示 操作 臂 的 加 
速 特性 ， 是 操作 臂 加 速度 分 析 的 基础 ， 动 力学 各 种 性 能 指标 也 都 直接 或 间接 与 之 有 关 。 

2. 广义 惯性 椭 球 GIE 

H. Asada 提出 的 广义 椭 球 GIE 实际 上 是 利用 笛 卡 儿 惯 性 矩阵 V(g)= "(gq)D(g)J'(9g) 
的 特征 值 来 度量 操作 辟 上 在 各 个 笛 卡 儿 方 向 上 的 加 速 特性 。 众 所 周知 ， 对 于 nxn 的 惯性 矩 
阵 V(q)， 二 次 方程 为 








(5-73) 











xiV(gq)x=1 (5-74) 

表示 n 维 空间 中 的 一 个 椭 球 ， 称 为 广义 惯性 椭 球 GIE。 椭 球 的 主轴 方向 就 是 矩阵 V(g) 
的 特征 矢量 方向 。 椭 球 上 主轴 的 长 度 等 于 矩阵 V(q) 特征 值 的 平方 根 。 因 而 用 广义 惯性 椭 
球 GIE 测量 衡量 操作 辟 的 加 速度 特征 具有 明显 的 几何 直观 性 。 在 工作 空间 的 任 一 点 ， 由 式 
(5-74) 可 作 一 椭 球 ， 该 点 动力 学 性 能 好 坏 可 用 这 点 对 应 的 椭 球 形状 来 衡量 ， 椭 球 越 接 近 球 ， 
动力 学 性 能 越 好 。 广 义 惯性 椭 球 完全 是 个 球 的 这 些 点 称 为 动力 学 各 向 同性 ， 与 前 面 定义 的 运 
动 学 各 向 同性 点 相似 ， 在 动力 学 各 向 同性 点 上 ， 惯 性 矩阵 V(g) 的 各 列 矢 量 相互 线性 独立 ， 
且 模 相等 。 

上 述 动力 学 性 能 方法 是 以 图 形 表示 机 器 人 广义 惯性 椭 球 作为 评价 动力 学 性 能 的 标准 。 然 
而 ， 这 种 方法 是 以 图 形 表 示 机 器 人 广义 惯性 的 变化 ， 因 此 只 适用 于 定性 分 析 。 

3. 动态 可 操作 性 椭 球 DME 

Yoshikawa 在 操作 臂 速度 分 析 的 基础 上 ， 用 雅 可 比 定义 可 操作 度 ， 又 在 加 速度 分 析 的 
基础 上 提出 了 类 似 的 指标 一 一 动态 可 操作 性 椭 球 DME。DME 是 基于 和 矩阵 巨 (4) ， 表 示 机 
器 人 的 关节 驱动 力矩 与 操作 加 速度 之 间 的 关系 。 由 于 E(q) 是 mxn 阶 矩 阵 ， 一 般 并 非 方 
阵 。 仿照 在 前 面 章节 用 雅 可 比 J(g) 定义 各 种 灵活 性 指标 的 方法 ,将 E(g) 进行 奇异 值 分 
解 有 
































E(g)=UEV (5-75) 
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Oo] 0 
0 0 
之 = . (5-76) 
0 ON 
01 宇 0, 宇 … 宇 oy 宇 0 是 矩阵 E(q) 的 奇异 值 ， 用 来 构造 动态 性 能 指标 .: 
CI 一 0O102 OnN 
> =01/0N 
(5-77) 
0W3 = ON 
0W4 = (Ca102 ON ) = 
仿照 运动 学 灵巧 度 的 概念 ， 将 w, 定义 为 动态 可 操作 性 的 度量 指标 ， 可 以 证 明 w 是 矩阵 
E(g) 的 条 件数 ， 即 





woi=Vdet[ E(g)E'(g)] (5-78) 
1E(g) E71(g) | ( 当 m=n, 且 非 奇异 时 ) 
We 1E(g) | IE'(g) | ( 当 mzn 时 ) oe 
mw; 是 E(g) 的 最 小 奇异 值 。w, 是 动态 可 操作 性 椭 球 DME 各 主轴 的 几何 均值 。 
基于 条 件数 w =k[E(g)] 还 可 定义 另 一 种 动态 各 向 同性 。 当 w, =1 时， 操作 臂 的 形 位 
称 为 动态 各 向 同性 。 在 设计 机 器 人 的 结构 时 ， 选 择 运动 学 和 动力 学 参数 尽量 使 最 小 条 件数 接 
近 1， 在 规划 路 径 时 ， 应 优先 考虑 最 小 条 件数 接近 1 的 形 位 。 


5.6 动力 学 优化 设计 





就 机 器 人 技术 而 言 ， 机 器 人 设计 是 很 重要 的 一 个 方面 。 目 前 ， 对 于 机 带 人 结构 设计 ， 绝 
大 多 数 是 以 运动 学 要 求 来 确定 ， 很 少 考虑 机 器 人 动力 学 性 能 。 然 而 ， 随 着 机 器 人 技术 的 发 
展 ， 要 求 机 器 人 有 较 高 的 操作 速度 、 准 确 的 定位 及 良好 的 控制 性 能 。 因 此 ， 在 机 锅 人 设计 中 
必须 考虑 其 动力 学 性 能 的 影响 。 

机 器 人 动力 学 特性 包括 : 各 关节 间 的 耦合 作用 ， 哥 式 力 和 离心 力 的 非 线性 影响 ， 以 及 取 
决 于 构 形 的 变化 惯量 。 从 动力 学 角度 看 ， 以 上 诸 因素 直接 影响 着 机 器 人 操作 性 能 。 鉴 于 机 顺 
人 机 构 参 数 对 其 动力 学 性 能 的 影响 ， 本 节 提 出 了 一 种 从 动力 学 观点 出 发 对 机 器 人 进行 优化 综 
合 的 方法 。 这 种 方法 的 目的 是 获得 优 恨 的 动力 学 性 能 ， 而 其 关键 问题 在 于 选择 反映 机 器 人 动 
力学 性 能 的 评价 函数 。 本 节 通 过 对 机 絮 人 动力 学 的 分 析 研 究 ， 并 考虑 控制 上 的 要 求 ， 介 绍 三 
个 评价 函数 : QD) 驱 动力 波动 函数 ; @ 惯 性 力 函 数 ; 名 能 量 函 数 。 这 三 个 评价 函数 从 不 同 的 侧 
面体 现 了 机 右 人 动力 学 特性 。 

从 动力 学 观点 对 机 器 人 进行 优化 综合 的 方法 实际 上 是 由 一 个 优化 程序 来 实现 的 。 优 化 程 
序 框图 如 图 5-5 所 示 。 由 图 可 知 ， 优 化 程序 包括 三 个 功能 程序 块 : 中 运动 学 模拟 程序 ;，@) 动 
力学 模拟 程序 ，(3) 优 化 算法 程序 。 

下 面 介 绍 各 功能 块 结构 。 

1. 运动 学 部 分 

在 研究 运动 学 时 ， 采 用 前 面 章 节 所 述 的 D-H 法 建立 机 器 人 坐标 系 。 
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(1) 典型 轨迹 的 规划 ”一般 来 说 ， 任 何 
机 絮 人 总 是 针对 某 类 具体 工作 而 设计 的 。 因 
此 ， 选 择 一 组 常用 的 工作 轨迹 做 典型 轨迹 。 
典型 轨迹 可 以 表示 为 r 
x=x( TV TY op,6) (5-80) 轨迹 规划 司马 交 
其 中 ，7T? ，T 代表 初始 点 、 端 点 的 位 
置 和 矩阵 ; v 代表 手 部 在 典型 轨迹 上 的 速度 规 
律 ， p 代表 手 部 姿态 变化 规律 ; 6 代表 离散 
点 分 布 规 律 。 ， 
典型 轨迹 可 以 是 直线 也 可 以 是 曲线 ， 通 
常 可 选择 离散 点 数 为 0~ 100 的 典型 轨迹 。 
(2) 运动 学 方程 与 反问 解 ” 对 于 NN 自由 
度 的 机 器 人 ， 每 个 构件 位 置 姿 态 矩 阵 由 下 式 
决定 : 





INPUT: 结 构 参 数 (SP), 其 它 
参数 (OP) 














党 六 性 过 沿 


求 反 向 解 ， 控 制 函数 





d(O-s-100 总 部 ) 




















动力 学 计算 O-0(4, 和, 世 …) 四 


动力 学 评价 函数 
P=P(Dynamics, SP) 











泣 蘑 性 过 起 























T,=TiA; (5-81)  ， ; 
其 中 ,TT, 是 标定 i 刚体 位 置 姿 态 的 4x4 i 
阶 和 矩阵 ，4; 是 i-1 刚体 与 刚体 间 的 4x4 阶 |， 作 je 
位 置 变换 矩阵 。 在 基础 坐标 系 中 ， 手 部 的 位 | 化 
置 姿 态 矩 阵 为 和 < > 
Ty=T0A1h,…Ay (5-82) 
按 反 向 递 推 | 








二 -1 -1 -1 
ToAiA,…A,=T\A\ AN 4 OUPUT: 优化 后 的 结构 
参 和 
(5-83) Se 


求 出 序列 号 尽 可 能 小 的 构件 的 位 置 和 姿 图 5-5 优化 程序 框图 
态 的 某 些 参量 ， 然 后 利用 其 中 的 特殊 方程 求 
出 g，g2，…，gws 

将 运动 链 拆 开 ,求解 阶 数 较 低 的 方程 组 。 

利用 机 构 的 特殊 构 型 ， 用 简单 的 几何 条 件 ， 分 别 求 出 gi ，q，，…，gqw。 

鉴于 反 向 解 的 多 解 性 ， 需 要 对 反 向 解 进 行 选择 。 目 前 ， 常 用 的 选取 标准 有 : 转角 限制 ; 
工作 过 程 中 各 关节 转角 之 和 最 小 的 原则 ; 工作 过 程 中 功 耗 最 小 的 原则 ;工作 过 程 中 耗 时 最 短 
的 原则 等 。 

(3) 形成 控制 函数 ”通过 运动 学 反 解 方 程 ， 即 可 得 到 各 个 关节 广义 坐标 的 离散 值 : 

q(t)=g j=0,1,2,.,M (5-84) 

其 中 ，M 是 典型 轨迹 上 的 离散 点 数 。 

然后 ， 在 这 个 离散 区 间 上 用 样 条 函数 择 值 就 能 形成 控制 函数 。 常 用 一 次 样 条 、 二 次 样 
条 、 三 次 样 条 ,或 者 更 高 次 样 条 来 做 插值 函数 ， 将 在 第 6 章 中 详细 介绍 。 其 选用 标准 主要 是 
插值 精度 、 计 算 效 率 和 曲线 光滑 程度 。 


从 样 条 控制 函数 可 得 到 各 个 离散 点 的 gg，q/，g;， 求 出 了 gy，q;，4 71， 运动 学 模拟 程 
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序 的 计算 即 完 成 。 

2. 动力 学 部 分 

对 机 器 人 动力 学 进行 分 析 和 研究 ， 建 立 反 映 机 内 人 动力 学 特性 的 评价 函数 。 

(1) 机 器 人 动力 学 模型 及 其 描述 方程 的 选取 机 器 人 机 构 是 一 个 多 刚体 、 多 关节 的 多 
自由 度 空间 的 开 式 链 机 构 。 目 前 常用 的 建立 机 器 人 动 力学 模型 的 方法 主要 有 : 拉 格 朗 日 法 、 
高 斯 法 、 牛 顿 一 欧 拉 法 和 凯 恩 法 等 。 而 确定 在 用 哪 一 类 方程 来 计算 关节 中 广义 力 时 ， 要 考虑 
下 面 几 个 因素 。 

1) 是 否 要 求 计算 关节 处 文 反 力 。 上 述 几 个 方程 均 可 计算 各 关节 处 的 广义 驱动 力 。 但 
是 ， 拉 格 朗 日 方程 不 能 给 出 关节 处 的 支 反 力 。 这 在 优化 构件 截面 尺寸 进行 强度 计算 时 ， 就 不 
能 应 用 。 所 以 ， 选 择 方程 时 要 针对 优化 对 象 看 看 是 否 需要 计算 支 反 力 。 

2) 计算 效率 。 当 确定 了 是 否 计算 支 反 力 后 ， 要 选择 能 给 出 的 计算 效率 高 的 方程 和 算法 ， 
以 利于 减少 优化 计算 时 的 计算 量 。 表 5-1 给 出 了 当 计 算 各 关节 中 广义 驱动 力 时 的 部 分 算法 的 
计算 效率 对 比 数 据 。 




















表 5-1 计算 效率 对 照 表 



































运算 次 数 
算法 类 型 自由 度数 
乘法 加 法 

Hollerbach( 1980) 拉 格 朗 日 方程 2195 1719 6 
Walker,Orin( 1982) 牛顿 一 欧 拉 方 程 1541 1196 6 
Silver( 1982 ) 拉 格 朗 日 方程 或 牛顿 一 欧 拉 方程 852 738 6 
Kane( 1983) 凯 恩 方程 646 394 6 
Popov( 1978) 高 斯 方程 6662 5382 6 








3) 是 否 方便 于 编制 程序 以 及 程序 中 间 输 出 参数 物理 意义 是 否 明确 。 对 于 一 种 算法 ， 要 
求 它 要 便于 编程 ， 并 且 其 中 间 输 出 参数 物理 意义 要 明确 。 高 斯 法 的 递 推 算法 在 编程 方面 较 其 
他 方法 容易 。 而 拉 格 朗 日 和 牛顿 一 欧 拉 法 中 间 参 数 物理 意义 明确 ， 高 斯 法 次 之 ， 凯 恩 法 
最 差 。 

统筹 考虑 上 述 三 个 方面 ， 可 以 选 定 一 种 较为 便利 的 动力 学 模拟 算法 。 

(2) 动力 学 性 能 评价 函数 ”进行 动力 学 性 能 的 比较 必须 要 有 一 定 的 标准 。 因 此 ， 确 定 机 
器 人 动力 学 评价 函数 无 疑 是 一 项 非常 重要 的 工作 。 

下 面 给 出 三 个 反映 机 器 人 动力 学 性 能 的 评价 函数 : 驱动 力 波动 函数 DR、 惯 性 力 函 数 RR 
和 能 量 也 数 。 





























7 


N N N 
1) 驱动 力 波动 函数 。 由 机 器 人 动力 学 方程 F,= 3》 J,(g) gi;+ > Cgj4i+Gi(g) 
1 下 | 1 


j=1k=1 
可 以 求 出 对 应 的 丽 值 ， 即 已 知 任意 一 个 离散 点 处 的 1g} ，1 9 ，1 9 上 总 可 以 求 出 离心 力 
上。 定义 函数 DR， 并 称 之 为 驱动 力 函 数 : 


次 
DR= 2oi( 之 [五 -五 ]?} (5-85) 


i J=1 
式 中 NN 一 一 机 妖 人 自由 度数 ， 
M 一 典型 轨迹 上 的 离散 点 数 ， 


下 一 点 上 i 关 方 的 广义 驱动 力 ; 


i 


入 
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i 关节 加 权 因 子 。 

对 于 机 器 人 动力 学 控制 来 讲 ， 每 两 个 离散 点 之 间 ， 驱 动力 波动 1 -FPF" | 越 小 越 好 。 否 
则 就 对 机 器 人 控制 系统 和 驱动 系统 的 稳定 性 、 反 应 速度 及 驱动 力 大 小 有 更 高 的 要 求 。 因 此 ， 
将 DR 作为 一 个 动力 学 评价 函数 ， 要求 其 越 小 越 好 。 奉 对 i 关节 无 特殊 要 求 可 令 wi=1。 

2) 必 数 。 为 分 析 方便 ， 将 惯性 力 项 与 离心 力 、 哥 氏 力 项 一 起 考虑 ， 统 称 之 为 惯 
性 力 函 数 。 惯 性 力 函 数 尺 定义 为 


y 
R= ~ vi{ 
式 中 ， 各 参数 意义 同 前 ，v， 
RR 也 数 反映 了 各 个 关节 中 惯 ee RR 越 小 则 反映 惯性 力 在 各 个 关节 处 的 
响应 值 越 小 。 因 此 ， 在 同样 的 运动 学 条 件 下 ，R 越 小 ， 动 力学 性 能 越 佳 。 
3) 能 量 孔 数 。 这 里 所 说 的 能 量 是 指 机 器 人 在 完成 操作 任务 时 所 消耗 的 能 量 。 一 般 表 达 
式 为 








M 
2 IF-G|) (5-86) 


5 











E= > (J ro) (5-87) 


i=1 
式 中 一 一 能 量 消耗 ; 
Ff.(q) 一 一 i 关节 中 广义 驱动 力 函 数 ; 
i 关节 中 广义 速度 值 ; 
7 一 一 完成 所 规定 的 轨迹 所 需 时 间 。 
能 量 函 数 的 离散 化 公式 可 以 表示 为 











NN 
= 2 O22 FP-F):(g -gg )1) (5-88) 
i=1j=2 


式 中 gi 一 点 上 i 关节 的 广义 坐标 值 ; 

其 余 各 参数 意义 同 前 。 

从 式 (5-88) 可 知 ， 能 量 函 数 是 驱动 力矩 与 关节 转角 的 乘积 。 当 运动 参数 不 变 时 ，E 
小 ， 则 王 1 F; | 越 小 。 因 此 ， 能 量 函 数值 越 小 ， 则 机 器 人 力学 性 能 越 好 ， 经 济 效 
越 好 。 

3. 确定 优化 方法 

(1) 目标 函数 “在 进行 动力 学 优化 综合 时 ， 目 标 函 数 可 根据 设计 要 求 选择 三 个 评价 函数 
中 的 任意 一 个 或 它们 的 线性 组 合 。 定 义 $ 为 目标 函数 

中 = 和 DR+A2R+A3 
式 中 ，A; ，A2 ，As 不 同 的 取 值 即 可 得 到 不 同 的 目标 函数 ， 见 表 5-2。 
表 5-2 ”目标 函数 表 





越 
也 








| 














中 Al A As 
DR 1 0 0 
R 0 1 0 
E 0 0 1 
DR+R+E 1 1 1 
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这 里 ，Ai，A; ，A3 作为 加 权 因 子 ， 其 作用 在 于 消除 各 目标 函数 在 数量 级 上 的 差异 。 

加 权 因 子 的 选择 要 服从 下 面 的 两 个 原则 : 

1) 使 各 评价 函数 与 其 加 权 因 子 的 乘积 不 产生 数量 级 上 的 差别 。 

2) 根据 不 同 的 动力 学 性 能 要 求 确定 加 权 因 子 间 的 比例 关系 。 

针对 以 4$ 为 目标 的 优化 综合 ， 设 计 一 种 A,，A; ，A3 的 确定 方法 ， 步 又 如 下 : 

1) 计算 出 DR，R, 的 初始 值 DR6。，Ro，Eo。 

2) 因为 Bo 值 大 小 适中 ， 故 取 As3 =1。 

3) 求 m ,ps 值 , p1=Eo/DRo; ps=Eo/Ro。 

4) 按 DR，R 相对 的 设计 要 求 ， 决 定 ;，t 值 。 

5) 确定 Ai，A2?: A1=s* pi1, As=t po 

一 般 情 况 下 单 目 标 函 数 优化 所 得 到 的 最 优化 设计 变量 因 目 标 而 异 。 因 此 ， 为 了 全 局 优化 
以 由 作为 目标 函数 较为 适宜 。 

(2) 设计 变量 可 以 选择 不 同 结构 参数 作为 设计 变量 : 中 构件 长 度 ; @ 构 件 界 面 尺寸 ; 
@@ 重 心 位 置 或 质量 分 布 。 当 然 也 可 以 是 多 个 参数 的 同时 优化 。 

设计 变量 的 选取 ， 决定 了 约束 条 件 及 优化 方法 的 类 型 ， 也 影响 着 动力 学 方程 的 选用 。 

(3) 约束 条 件 

1) 空间 可 达 性 约束 。 保 证 优化 设计 后 ， 工 作 空间 不 变 或 者 改变 不 致 影响 设计 操作 任务 
的 完成 。 

2) 驱动 力 约束 。 保 证 优化 设计 后 ， 各 关节 所 需 的 驱动 力 值 不 超过 驱动 带 的 额定 值 。 

3) 应 力 约束 。 保 证 优化 设计 后 ， 各 物件 中 最 大 应 力 不 超过 其 许 用 值 。 

4) 弹性 变形 约束 。 保 证 优化 设计 后 ， 构 件 在 工作 时 弹性 变形 不 超过 许 用 值 及 运动 精度 
要 求 。 

上 述 三 个 方面 确定 后 ， 即 可 选取 合适 的 优化 算法 。 


5.7 拉 格 朗 日 动力 学 


拉 格 天 日 动力 学 是 基于 能 量 平 衡 方 程 ， 仅 能 量 项 对 系统 变量 及 时 间 的 微分 ， 只 需求 速度 而 
无 须 求 内 力 (系统 各 内 力 ) ， 因 此 ， 机 器 人 的 拉 格 朗 日 力学 方程 较为 简洁 ， 求 解 也 比较 容易 。 

1. 拉 格 朗 日 函数 

拉 格 明日 函数 亏 的 定义 是 一 个 机 械 系统 的 动能 E 和 势能 ,之 差 ， 即 

L=E,-E, (5-89) 

邻 yg (=1，2，…, n) 是 使 机 器 人 系统 具有 完全 确定 位 置 的 广义 关节 变量 ，g, 是 相应 
的 广义 关节 速度 。 由 于 系统 动能 Ei 是 qi 和 9; 的 函数 ， 系 统 势能 ,是 q; 的 函数 ， 因 此 拉 格 
朗 日 函数 也 是 qi 和 gq; 的 函数 。 

2. 拉 格 朗 日 方程 

对 于 n 个 连 杆 组 成 的 机 器 人 系统 ， 由 拉 格 天 日 函数 描述 的 系统 动力 学 方程 为 


Pi=—— ,i=1,2,,n (5-90) 
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其 中 ，F, 称 为 关节 i 的 广义 驱动 力 。 如 果 是 移动 关节 ， 则 玉 为 驱动 力 ; 如 果 是 转动 关 
节 ， 则 ,为 驱动 力矩 。 

3. 用 拉 格 朗 日 法 建立 机 器 人 动力 学 方程 的 步 又 

1) 选取 坐标 系 ， 选 定 完全 而 且 独 立 的 广义 关节 变量 9 (i=1，2，…，m)。 

2) 选 定 相 应 的 关节 上 的 广义 驱动 力 F,， 当 g, 是 位 移 变量 时 ， 则 F; 力 ; 当 g; 是 角度 变 
量 时 ， 则 为 力矩 。 

3) 求 出 机 器 人 各 构件 的 动能 和 势能 ， 构 造 拉 格 朗 日 函数 。 

4) 代入 拉 格 朗 日 方程 ， 求 得 机 器 人 系统 的 动力 学 方程 。 

4. 方程 简化 措施 

1) 当 杆 件 长 度 不 太 长 ， 重 量 很 轻 时 ， 重 力矩 项 可 以 省 略 。 

2) 当 关 节 速度 不 太 大 ， 机 器 人 低速 运行 时 ， 含 有 乓 ， 的 ，6 ， 和 的 项 可 以 省 略 。 


2 
3) 当 关 节 加 速度 不 太 大 ， 即 关节 电动 机 升 、 降 速 比较 平稳 时 ， 含 有 0 ,|，9, 的 项 有 时 
可 以 省 略 。 但 关节 加 速度 减 小 会 引起 速度 升降 的 时 间 增 加 ， 延 长 机 器 人 完成 作业 的 时 间 。 


5.8 操作 臂 的 动力 学 建 模 和 仿真 


机 器 人 动力 学 研究 的 是 各 杆 件 的 运动 和 作用 力 之 间 的 关系 。 机 器 人 动力 学 分 析 是 机 器 人 
设计 、 运 动 仿 真 和 动态 实时 控制 的 基础 。 机 器 人 动力 学 问题 有 两 类 : 

动力 学 正 问题 一 已 知 关 节 的 驱动 力矩 ， 求 机 器 人 系统 相应 的 运动 参数 (包括 关节 位 
移 、 速 度 和 加 速度 ) 。 

动力 学 逆 问 题 
动力 和 矩 。 

机 器 人 动力 学 问题 的 求解 比较 困难 ， 而 且 需 要 较 长 的 运算 时 间 。 拉 格 衣 日 方法 不 仅 能 以 
最 简单 的 形式 求 得 非常 复杂 的 系统 动力 学 方程 ， 而 且 具 有 显 式 结构 ， 物 理 意义 比较 明确 ， 对 
理解 机 器 人 动力 学 比较 方便 。 因 此 ， 简 化 求解 的 过 程 ， 最 大 限度 地 减少 机 器 人 动力 学 在 线 计 
算 的 时 间 是 一 个 备 受 关注 的 研究 课题 。 

下 面 以 二 自由 度 平面 关节 型 机 器 人 进行 动力 学 实 
例 分析 ， 并 利用 拉 格 朗 日 方法 建立 动力 学 方程 。 

1. 广义 关节 变量 及 广义 力 的 选 定 

选取 笛 卡 儿 坐 标 系 如 图 5-6 所 示 。 连 杆 1 和 连 杆 
2 的 质量 分 别 为 m 和 m ， 杆 长 分 别 为 上 和 1,， 质心 
分 别 在 Cl 和 C, 处 ， 离 相应 关节 中 心 的 距离 分 别 为 p] 
和 p,。 连 杆 1 和 连 杆 2 的 关节 变量 分 别 为 转角 0， 和 
和， 关节 1 和 关节 2 相应 的 驱动 力矩 是 7| 和 7,。 
结合 图 5-6 建立 的 坐标 系 ， 可 得 杆 1 质心 C 的 位 置 
坐标 为 图 5-6 二 自由 度 机 器 人 动力 学 方程 的 建 


x1 =pisinO] 
































已 知 运动 轨迹 点 上 的 关节 位 移 、 速 度 和 加 速度 ， 求 出 所 需要 的 关节 驱 























yoh 
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y1= -picos0 
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杆 1 质心 Ci 的 速度 平方 为 
%1+y1=(p101)? 
杆 2 质心 C, 的 位 置 坐标 为 
x» =/isin0i+Dosin( 01 +0, ) 
y=-licos01 -pocos( 01+0,) 
杆 2 质心 C, 的 速度 平方 为 
x =licosO O01+pscos( 01+0,) (01+0,) 
ya =11singi 01+p,sin( 01+0, ) ( 01+0,) 
72 Otp( 0 46 )2420p2( O240, 人 ) eosb, 
2. 系统 动能 


1 2 22 
En 2D Ci 
1 | 
Ey = ml 1 + m2p2( 01+03)? +tmolips( O07+010,)cos0, 


2 
1 :> 几 a 人 
Ei = > Ens=3 (mpi tm ) 0 + mp O01+02)" tmalipa( O07+010,)cos0, 
i=1 


3. 系统 势能 (以 质心 处 于 最 低位 置 为 势能 零点 ) 
El =migpi( 1-cos01 ) 
Es=magli(1-cos0)+mgpal 1-cos( 01+0,) ] 


2 
b,= 2 Ei= (mpitmali)g( 1-cos0)+mgpal 1-cos(01+0,) ] 


i=1 
4. 拉 格 朗 日 函数 
L =E,-E, 


1 .» 1 a 
=3 (mipitmal) b+ map2( 0 +0，) tmlips( b+0， 0 ) cos0> 


—(mipitm2li)g(1-cos01) -mgp2l 1-cos( 01+0,) ] 
5. 系统 动力 学 方程 
拉 格 朗 日 方程 为 
po 
digg, 0g; 
计算 各 关节 上 的 力矩 ， 可 得 到 系统 动力 学 方程 。 
计算 关节 1 上 的 力矩 ri : 
mp emad) Oy tmapi Birds) tmalipa(201 + oon, 
1 
oL 
a01 
根据 拉 格 明日 方程 可 得 


= 一 人 (71iP1I+moll )gsin0l 一 mpzsin( 01+0, ) 
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da aL 


T1™ . 一 
db， 00) 


5 5 5 
(mipitm2p; tmaly 二 272211D2cos02 ) 01+( mp, tmalip2cos0,) 0 ,+ 


(~2malipssingy) 0102+( —molipssinO, ) O72+( mipitm2li )gsinO! tmgp2sin( 01+0, ) 





上 式 可 简写 为 
71=D11 0 1+D12 0 s+D11201 0,+D12 0607+D,) 
式 中 : 
Di =mip? tmop? tmali +2m2lip2cos0, 
Dr =m277 +m2lip2c0s0, 
Dip = -2m,l1p»sing, 
Dizz = -malip2sinO, 
Di=(mipitm2li )gsin0 tmgp2sin( 01+0, ) 
求 关 节 2 上 的 力矩 r，: 
—=m2p,( 01+0,)+m,lip2 O01co0s0, 
5 
—=—m,lip,( O07+01 0， ) sing, -mp8D2sin(O+O， ) 
根据 拉 格 朗 日 方程 可 得 
dor al 


27 gL90, 90, 
=( map +tmalip2cos0,) 0 1+m2p2 0 s+[ (—molips+molip )sing, ] 010, 
+( mlip2sing, ) 0? +m2gp2sin( O01+0, ) 
上 式 可 简写 为 
72=D21 0 1+D2 0 ,+D212010,+D21101+D, 
式 中 : 

2 
D21 =m2p; tm lip2c0s0, 

2 
D»» mp, 
D2 =( molips tmolip, ) sing, 


Do =m, lip2sing, 





D,=m,gpsin( 011+0, ) 


(5-91) 


(5-92) 


(5-93) 


(5-94) 


式 (5-91)、 式 (5-92) 及 式 (5-93)、 式 (5-94) 分 别 表示 了 关节 驱动 力矩 与 关节 位 
移 、 速 度 、 加 速度 之 间 的 关系 ， 即 力 和 运动 之 间 的 关系 ， 称 为 图 5-6 所 示 二 自由 度 机 器 人 的 


动力 学 方程 。 对 上 述 公式 进行 分 析 可 知 : 
1) 含有 6 1 或 6， 的 项 表示 由 于 加 速度 引起 的 关节 力矩 项 ， 其 中 
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含有 Di 和 Dy 的 项 分 别 表示 由 于 关节 1 加 速度 和 关节 2 加 速度 引起 的 惯性 力矩 项 ; 

含有 D1s 的 项 表示 关节 2 的 加 速度 对 关节 1 的 耦合 惯性 力矩 项 ; 

含有 Dai 的 项 表示 关节 1 的 加 速度 对 关节 2 的 耦合 惯性 力矩 项 。 

2) 含有 名 和 如 的 项 表示 由 于 向 心力 引起 的 关节 力矩 项 ， 其 中 : 

含有 Diws 的 项 表示 关节 2 的 速度 引起 的 向 心力 对 关节 1 的 耦合 力矩 项 ; 

含有 Dai 的 项 表示 关节 1 的 速度 引起 的 向 心力 对 关节 2 的 耦合 力矩 项 。 

3) 含有 0 6， 的 项 表示 由 于 哥 氏 力 引起 的 关节 力矩 项 ， 其 中 ， 

含有 Di 的 项 表示 哥 氏 力 对 关节 1 的 耦合 力矩 项 ; 

含有 Di 的 项 表示 哥 氏 力 对 关节 2 的 耦合 力矩 项 。 

4) 只 含 关节 变量 9, 、0, 的 项 表示 重力 引起 的 关节 力矩 项 。 其 中 ， 

含有 六 的 项 表示 连 杆 1、 连 杆 2 的 质量 对 关节 1 引起 的 重力 矩 项 ; 

含有 记 的 项 表示 连 杆 2 的 质量 对 关节 2 引起 的 重力 矩 项 。 

从 上 面 推导 可 以 看 出 ， 结 构 简 单 的 二 自由 度 平面 关节 型 机 器 人 其 动力 学 方程 已 经 很 复 
杂 ， 包 含 很 多 因素 ， 这 些 因素 都 影响 机 器 人 的 动力 学 特性 。 对 于 复杂 一 些 的 多 自由 度 机 器 
人 ， 动 力学 方程 更 庞杂 了 ， 推 导 过 程 也 更 为 复杂 。 不 仅 如 此 ， 给 机 器 人 实时 控制 也 带 来 不 小 
的 麻烦 。 通 常 ， 寻 求 一 些 简化 问题 的 方法 ， 内 容 详 见 5.7 节 部 分 所 述 。 












































5.9 本 音 小 结 





机 器 人 动力 学 是 机 絮 人 控制 的 基础 。 本 划 主 要 介绍 了 机 带 人 动力 学 问题 的 两 种 常用 方 
法 : 牛顿 一 欧 拉 法 和 拉 格 于 日 法 。 在 动力 学 分 析 的 基础 上 ， 介 绍 了 几 种 动力 学 性 能 指标 ， 并 
介绍 了 三 个 评价 函数 : (由 驱动 力 波动 函数 ， 避 惯性 力 函 数 ，( 能 量 函 数 。 本 章 分 析 了 机 器 人 
机 构 参 数 对 其 动力 学 特性 的 影响 ， 介 绍 了 一 种 适用 于 多 自由 度 机 器 人 的 动力 学 优化 综合 
法 。 最 后 以 二 自由 度 平面 关节 型 机 器 人 为 例 进行 动力 学 分 析 ， 并 利用 拉 格 朗 日 方法 建立 动力 


学 方程 。 





习 题 
5-1 简 述 建立 机 器 人 运动 学 方程 和 动力 学 方程 的 方法 和 步骤 。 
5-2” 简 述 拉 格 天 日 方程 的 一 般 表示 形式 ， 以 及 各 变量 表示 的 含义 。 
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6.1 概述 


机 器 人 控制 系统 是 根据 指令 以 及 传 感 信息 控制 机 器 人 完成 一 定 的 动作 或 作业 任务 的 装 
置 ， 它 是 机 器 人 的 大 脑 ， 决 定 了 机 器 人 性 能 的 优 劣 。 机 器 人 的 控制 系统 与 其 设计 目标 和 实现 
功能 密切 相关 ， 不 同类 型 的 机 器 人 ， 其 控制 系统 可 能 差别 很 大 ， 但 它们 也 有 一 些 共同 的 
特点 。 

早期 的 机 器 人 都 用 液压 、 气 动 方式 来 进行 伺服 驱动 。 随 着 大 功率 交流 伺服 驱动 技术 的 发 
展 ， 目 前 大 部 分 被 电气 驱动 方式 所 代替 ， 只 有 在 少数 要 求 超大 的 输出 功率 、 防 爆 、 低 运动 精 
度 的 场合 才 考 虑 使 用 液压 和 气压 驱动 。 电 气 驱 动 无 环境 污染 ， 响 应 快 ， 精 度 高 ， 成 本 低 ， 控 
制 方便 。 电 气 驱 动 按照 执行 元 件 的 不 同 又 分 为 步 进 电动 机 驱动 、 直 流 伺服 电动 机 驱动 和 交流 
伺服 电动 机 驱动 三 种 不 同 的 方式 ; 按照 伺服 控制 方式 分 为 开 环 、 闭 环 和 半 闭 环 伺服 控制 系 
统 。 步 进 电 动机 驱动 一 般 用 在 开 环 伺服 系统 中 ， 这 类 系统 没有 位 置 反馈 装 置 ， 控 制 精度 相对 
较 低 ， 适 用 于 位 置 精 度 要 求 不 高 的 机 器 人 ; 交 、 直 流 伺服 电动 机 用 于 闭环 和 半 闭 环 伺服 系统 
中 ， 这 类 系统 可 以 精确 测量 机 器 人 关节 和 末端 执行 器 的 实际 位 置信 息 ， 并 与 理论 值 进 行 比 
较 ， 把 比较 后 的 插值 反馈 输入 ， 校 正 输入 指令 值 ， 所 以 这 类 系统 具有 很 高 的 控制 精度 。 

机 器 人 的 控制 系统 包含 对 机 器 人 本 体 工作 过 程 进行 控制 的 控制 机 、 机 器 人 专用 传 感 絮 和 
运动 伺服 驱动 系统 等 。 控 制 系 统 主要 对 机 器 人 工作 过 程 中 的 动作 顺序 、 期 望 的 位 置 及 姿态 、 
路 径 轨 迹 及 规划 、 动 作 时 间 间 隔 及 末端 执行 器 施加 在 被 作用 物 上 的 力 和 力矩 等 进行 控制 。 控 
制 系统 中 涉及 传 感 技 术 、 了 驱动 技术 、 控 制 理论 和 控制 算法 。 

对 机 器 人 而 言 ， 从 控制 算法 的 处 理 方式 来 看 ， 可 分 为 串 行 和 并 行 两 种 结构 。 

1. 串 行 处 理 结构 

所 谓 的 串 行 处 理 结构 是 指 机 器 人 的 控制 算法 是 由 串 行 处 理 机 构 来 处 理 的 。 对 于 这 种 类 型 
的 控制 器 ， 从 计算 机 结构 、 控 制 方式 来 划分 ， 可 分 为 以 下 几 种 : 

(1) 单 CPU 结构 、 集 中 控制 方式 ”用 一 台 功 能 较 强 的 计算 机 来 实现 全 部 控制 功能 。 在 
早期 的 机 器 人 中 就 采用 这 种 结构 ， 但 控制 过 程 中 需要 许多 计算 (如 坐标 变换 )， 因 此 这 种 控 
制 结构 速度 较 慢 。 

(2) 二 级 CPU 结构 、 主 从 控制 方式 一 级 CPU 为 主机 ， 完 成 系统 管理 、 机 器 人 语言 
编译 和 人 机 接口 功能 ， 同 时 也 利用 它 的 运算 能 力 完成 坐标 变换 、 轨 迹 插 补 ， 并 定时 地 把 
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运算 结果 作为 关节 运动 的 增 量 送 到 公用 内 存 ， 供 二 级 CPU 读 取 ; 二 级 CPU 完成 全 部 关节 
位 置 数字 控制 。 这 类 系统 的 两 个 CPU 总 线 之 间 基 本 没有 联系 ， 仅 通过 公用 内 存 交 换 数 据 ， 
是 一 个 松 耦 合 的 关系 ， 对 采用 更 多 的 CPU 进一步 分 散 功能 是 很 困难 的 。 日 本 于 20 世纪 
70 年 代 生 产 的 Motoman 机 器 人 (5 关节 ， 直 流 电 动机 驱动 ) 的 计算 机 系统 就 属于 这 种 主 
从 式 结构 。 

(3) 多 CPU 结构 、 分 布控 制 方式 ” 目 前 ,普遍 采用 这 种 上 、 下 位 机 二 级 分 布 式 结构 ， 
上 位 机 负责 整个 系统 管理 以 及 运动 学 计算 、 轨 迹 规划 等 ;下 位 机 由 多 CPU 组 成 ， 每 个 CPU 
控制 一 个 关节 运动 ， 这 些 CPU 和 主机 的 联系 是 通过 总 线形 式 的 紧 耦 合 。 这 种 结构 的 控制 器 
工作 速度 和 控制 性 能 明显 提高 。 但 这 些 多 CPU 系统 共有 的 特征 都 是 针对 具体 问题 而 采用 的 
功能 分 布 式 结构 ， 即 每 个 处 理 器 承担 固定 任务 。 目 前 世界 上 大 多 数 商品 化 机 器 人 控制 都 是 这 
种 结构 。 

上 述 串 行 控制 系统 存在 一 个 共同 的 弱点 : 系统 运算 的 实时 性 差 。 所 以 ， 大 多 采用 离线 规 
划 和 前 馈 补偿 解 厢 等 方法 来 减轻 实时 控制 中 的 计算 负担 。 当 机 器 人 在 运行 中 受到 干扰 时 其 性 
能 将 受到 影响 ， 更 难以 保证 高 速 运动 中 所 要 求 的 精度 指标 。 

2. 并 行 处 理 结构 

并 行 处 理 结构 是 提高 计算 机 速度 的 一 个 重要 而 有 效 的 手段 ， 能 满足 机 器 人 控制 的 实时 性 
要 求 。 构 造 并 行 处 理 结构 的 机 器 人 控制 系统 一 般 采 用 以 下 方式 : 

(1) 开发 机 器 人 控制 专用 VSLI 设计 专用 VSLI 能 充分 利用 机 器 人 控制 算法 的 并 行 
性 ， 依 靠 芯片 内 的 并 行 体系 及 结构 易于 解决 机 器 人 控制 算法 中 出 现 的 大 量 计 算 ， 能 大 
大 提高 运动 学 、 动 力学 方程 的 计算 速度 。 但 由 于 芯片 是 根据 具体 的 算法 来 设计 的 ， 当 
算法 改变 时 ， 世 片 则 不 能 使 用 ， 因 此 采用 这 种 方式 构造 的 控制 锅 不 通用 ， 更 不 利于 系 
统 的 维护 与 开发 。 

(2) 用 有 并 行 处 理 能 力 的 芯片 式 计算 机 构成 并 行 处 理 网 络 ”Tansputer 是 一 种 典型 的 并 
行 性 处 理 器 ， 它 是 1985 年 由 英国 INMOS 公司 首先 研发 成 功 的 一 种 面向 多 机 系统 构造 的 新 型 
处 理 器 。 它 将 中 央 处 理 器 、 存 储 器 和 高 速 通信 接口 等 多 种 功能 集成 在 一 块 硅 片 上 。 每 个 
Tansputer 含有 高 速 读 写 存储 器 ， 并 拥有 4 对 通信 和 链 路 接口 和 两 个 定时 器 。 通 信 接 口 全 双 工 
异步 通信 ， 波 特 率 最 高 可 达 20M。 定 时 器 可 用 于 并 行 任务 的 调度 。 默 认 的 硬件 连接 拓扑 结构 
是 Pipeline 型 ， 用 户 也 可 用 硬件 连接 构成 其 他 多 种 形式 的 互联 拓扑 结构 ， 或 用 文 撑 软 件 S708 
编程 来 设置 软 开 关 ， 重 构 拓扑 结构 。Transputer 处 理 器 可 利用 Occam 语言 进行 软件 设计 和 硬 
件 配置 ， 为 并 行 系统 设计 提供 一 种 新 的 方法 。 

(3) 利用 通用 的 微 处 理 器 “利用 通用 微 处 理 器 构成 并 行 处 理 结构 ， 文 持 计算 ， 可 实现 复 
杂 控 制 策略 在 线 实时 计算 。 

目前 广泛 使 用 的 机 器 人 中 ， 控 制 机 多 为 微型 计算 机 ， 外 部 有 控制 柜 封 装 。 如 日 本 安 川 的 
Motoman 机 器 人 以 及 美国 AMF 公司 的 Versatran 机 器 人 等 。 这 一 类 机 器 人 一 般 采 用 示 教 一 再 
现 的 工作 方式 ， 机 器 人 的 作业 路 径 、 运 动 参数 由 操作 者 手把手 示 教 或 通过 程序 设 定 ， 机 器 人 
重复 再 现 示 教 的 内 容 ; 机 器 人 配 有 简单 的 内 部 传 感 带 ， 用 来 感知 运行 速度 、 位 置 和 姿态 等 ; 
还 可 以 配备 视觉 、 力 传感器 感知 外 部 环境 。 

近年 来 ,智能 机 器 人 的 研究 成 为 热点 。 这 类 机 器 人 具有 自主 感知 、 人 处 理 、 决 策 、 执 行 的 
能 力 ， 其 控制 信息 量 大 ， 控 制 算 法 复杂 。 同 时 配备 了 多 种 内 部 、 外 部 传感器 ， 不 但 能 感知 内 
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部 关节 运行 速度 及 力 的 大 小 ， 还 能 对 外 部 的 环境 信息 进行 感知 、 反 馈 和 人 处 理 。 


6.2 机 器 人 信息 检测 装置 


传感器 好 比 人 的 五 官 ， 人 通过 五 官 : 眼 (视觉 )、 耳 (听觉 )、 盘 (嗅觉 )、 舌 ( 味 
觉 )、 四 肢 身 体 (触觉 感知 和 接收 外 界 的 信息 ， 然 后 通过 神经 系统 传输 给 大 脑 进 行 加 工 处 
理 。 传 感 器 则 是 一 个 控制 系统 的 “ 电 五 官 ” ， 它 感 测 到 外 界 的 信息 ， 然 后 反馈 给 系统 的 处 理 
器 即 “电脑 ”进行 加 工 处 理 。 如 果 一 个 控制 系统 没有 传感器 ， 就 像 一 个 人 没有 五 官 ， 其 结 
果 是 可 想 而 知 的 。 

传感器 是 借助 检测 元 件 将 一 种 形式 的 信息 转换 成 另 一 种 信息 的 装置 。 根 据 一 般 传感器 在 
系统 中 所 发 挥 的 作用 ， 完 整 的 传感器 包括 敏感 元 件 、 转 换 元 件 和 基本 转换 电路 三 部 分 。 敏 感 
元 件 的 基本 功能 是 将 某 种 不 便 测 量 的 物理 量 转换 为 易于 测量 的 物理 量 ， 转 换 元 件 与 敏感 元 件 
一 起 构成 传感器 的 结构 部 分 ， 而 基本 转换 电路 是 将 敏感 元 件 产生 的 易 测量 小 信号 进行 变换 ， 
使 传感器 的 输出 符合 具体 工业 系统 的 要 求 (如 4~20mA、-5~5V)。 


6.2.1 传感器 的 要 求 和 特点 


为 了 证 机 器 人 工作 ， 必 须 对 机 器 人 的 手 部 位 置 、 速 度 、 姿 态 等 进行 测量 和 控制 ， 还 要 了 
解 操作 对 象 所 处 的 环境 。 当 机 器 人 直接 对 目标 进行 操作 时 ， 如 果 改 变 了 外 部 环境 ， 就 可 能 进 
入 到 预料 不 到 的 工 况 ， 从 而 导致 意外 的 结果 。 因 此 ， 必 须 掌 握 变化 的 动态 环境 ， 使 机 器 人 相 
应 的 工作 顺序 和 操作 内 容 自然 地 适应 工 况 的 变化 。 从 而 使 机 器 人 获取 内 部 和 外 部 有 用 信息 ， 
实现 机 器 人 信息 检测 和 分 析 ， 对 提高 机 器 人 的 运动 效率 和 工作 效率 ， 节 省 能 源 ， 防 止 危险 的 
发 生 都 是 非常 重要 的 。 

机 器 人 的 信息 检测 是 依靠 各 种 传感器 来 完成 的 。 机 器 人 的 信息 检测 分 为 两 类 ， 即 内 部 感 
知 和 外 部 感知 。 因 此 ， 根 据 检测 对 象 的 不 同 可 分 为 内 部 传 感 希 和 外 部 传 感 融 。 内 部 传 感 顺 用 
于 检测 和 感知 机 器 人 本 身 的 状态 ， 如 位 置 、 速 度 、 加 速度 等 ;外 部 传感器 主要 在 识别 环境 、 
工件 情况 以 及 工件 与 机 器 人 关系 上 起 作用 ， 见 表 6-1 和 表 6-2。 使 用 外 部 传 感 顺 可 以 使 机 吕 
人 对 外 部 环境 具有 一 定 的 适应 能 力 ， 并 赋予 机 器 人 一 定 的 智能 。 

表 6-1 内 部 传感器 














































































































传感器 检测 功能 
码 盘 .电位 器 光栅 度 ,位移 
速度 传感器 速度 .角速度 
加 速度 传感器 加 速度 
倾斜 仪 项 斜 角度 
陀螺 仪 方位 
力 / 力 失传 感 器 力 /力矩 
表 6-2 外 部 传感器 





传感器 感知 传 感 右 感知 























视觉 传感器 外 部 环境 嗅觉 传感器 气味 
触觉 滑 觉 传感器 接触 滑动 听觉 传 感 器 声音 
接近 觉 传感器 距离 味觉 传感器 味道 
热 觉 传感器 温度 度 觉 传感器 ( 陀螺 仪 ,倾斜 仪 ) 方位 

力 觉 传感器 力 和 力矩 
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内 部 传 感 需 是 测量 机 器 人 自身 状态 的 传感器 ， 可 用 于 伺服 控制 中 。 具 体检 测 对 象 有 关节 
的 线 位 移 、 角 位 移 等 几何 量 ， 速 度 、 角 速度 、 加 速度 等 运动 量 ， 还 有 倾斜 角 、 方 位 角 、 振 动 
等 物理 量 。 对 各 种 传感器 的 要 求 是 精度 高 、 咱 应 速度 快 、 测 量 范 围 宽 。 内 部 传感器 中 ， 位 置 
传感器 和 速度 传感器 是 机 器 人 伺服 控制 中 不 可 缺少 的 元 件 。 

外 部 传 感 占 通常 用 来 构成 机 带 人 的 感知 系统 ， 通 过 这 些 传 感 融 ， 机 器 人 获得 其 所 处 环境 
的 相关 信息 。 这 类 传感器 通常 有 视觉 传感器 、 触 / 滑 觉 传感器 、 力 /力矩 传感器 、 接 近 觉 传 感 
器 和 听觉 传感器 。 

传 感 系统 对 于 采集 环境 、 工 件 和 机 器 人 状态 信息 是 必 不 可 少 的 。 机 器 人 传感器 系统 与 其 
他 系统 不 同 ， 它 不 仅 要 有 检测 和 测量 状态 信息 的 能 力 ， 而 且 要 处 理 采 集 到 的 信息 ， 并 根据 采 
集 到 的 信息 对 外 部 采取 行动 ,因此 它 应 有 很 强 的 实时 采集 和 处 理 信息 的 能 力 。 如 果 获 取 的 信 
息 不 够 ， 传 感 器 系统 应 主动 地 采集 为 达到 目标 所 需 的 信息 。 

1. 传感器 的 定义 

传感器 是 借助 检测 元 件 将 一 种 形式 的 信息 转换 成 另 一 种 信息 的 装置 。 目 前 ， 传 感 器 转换 
后 的 信号 大 多 为 电信 号 。 因 而 从 狭义 上 讲 ， 传 感 器 是 把 外 界 输入 的 非 电信 号 转换 成 电信 号 的 
装置 。 事 实 上 传感器 是 一 种 按 一 定 的 精确 度 、 规 律 将 被 测量 〈 物 理 的 、 化 学 的 和 生物 的 信 
息 ) 转换 成 与 之 有 确定 关系 的 、 便 于 应 用 的 某 种 物理 量 (通常 是 电量 ) 的 测量 装置 。 它 是 
自动 控制 系统 (机 器 人 ) 必 不 可 少 的 关键 部 分 。 

2. 传感器 的 构成 

测试 系统 的 组 成 如 图 6-1 所 示 。 主 要 由 被 测 对 象 、 传 感 涡 、 中 间 变 换 装 置 和 显示 记录 装 


置 等 组 成 。 
CD 
物理 量 


传 感 占 的 组 成 框图 如 图 6-2 所 示 。 其 中 ， 
敏感 元 件 的 作用 是 感受 被 测 物 理 量 ， 并 对 信号 
进行 转换 输出 。 辅 助 元 件 则 是 对 敏感 元 件 输出 
的 电信 号 进行 放大 、 阻 抗 匹配 ， 以 便于 后 续 仪 
表 接 入 。 

3. 传感器 的 主要 性 能 指标 

为 评价 或 选择 传感器 ， 通 和 常 需要 确定 传 感 
器 的 性 能 指标 ， 传 感 顺 的 性 能 指标 又 分 为 静态 特性 与 动态 特性 。 

(1) 传感器 的 静态 特性 ”传感器 的 静态 特性 是 指 对 静态 的 输入 信号 ， 传 感 需 的 输出 量 与 
输入 量 之 间 所 具有 的 相互 关系 。 因 为 这 时 输入 量 和 输出 量 都 和 时 间 无 关 ， 所 以 它们 之 间 的 关 
系 ， 即 传感器 的 静态 特性 可 用 一 个 不 含 时 间 变 量 的 代数 方程 ， 或 以 输入 量 做 横 坐 标 ， 把 与 其 
对 应 的 输出 量 做 纵 坐 标 而 画 出 的 特性 曲线 来 描述 。 表 征 传感器 静态 特性 的 主要 参数 有 : 线性 
度 、 灵 敏 度 、 分 辨 力 、 量 程 和 述 沛 等 。 
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图 6-1 测试 系统 的 组 成 
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图 6-2 ” 传 感 咒 的 组 成 框图 
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1) 传感器 的 线性 度 。 通 常情 况 下 ， 传 感 器 的 实际 静态 特性 输出 是 条 曲线 而 非 直线 。 在 
实际 工作 中 ， 为 使 仪表 具有 均匀 刻度 的 读数 ， 常 用 一 条 拟 合 直线 近似 地 代表 实际 的 特性 曲 
线 ， 线 性 度 〈 非 线性 误差 ) 就 是 这 个 近似 程度 的 一 个 性 能 指标 。 拟 合 直 线 的 选取 有 多 种 方 
法 ， 如 将 零 输 入 和 满 量 程 输出 点 相连 的 理论 直线 作为 拟 合 直线 ; 或 将 与 特性 曲线 上 各 点 偏差 
的 平方 和 为 最 小 的 理论 直线 作为 拟 合 直线 ， 此 拟 合 直线 称 为 最 小 二 乘法 拟 合 直线 。 

2) 传感器 的 灵敏 度 。 灵 敏 度 是 指 传感器 在 稳 态 工作 情况 下 输出 量变 化 Ay 对 输入 量变 化 
Ax 的 比值 。 它 是 输出 一 输入 特性 曲线 的 斜率 。 如 果 传 感 器 的 输出 和 输入 之 间 呈 线性 关系 ， 
则 灵敏 度 $ 是 一 个 常数 。 否 则 ， 它 将 随 输入 量 的 变化 而 变化 。 

Ay 
An 

灵敏 度 的 量 纲 是 输出 、 输 入 量 的 量 纲 之 比 。 例 如 ， 某 位 移 传感器 ， 在 位 移 变化 1mm 时 ， 
输出 电压 变化 为 200mV， 则 其 灵敏 度 应 表示 为 200mV/mm。 当 传感器 的 输出 、 输 入 量 的 量 
纲 相同 时 ， 灵 敏 度 可 理解 为 放大 倍数 。 

如 果 传 感 器 的 输出 和 输入 之 间 呈 曲线 关系 ， 则 灵敏 度 就 是 该 静态 特性 曲线 的 导数 ; 

dy 
0 

提高 灵敏 度 ， 可 得 到 较 高 的 测量 精度 。 但 灵敏 度 越 高 ， 测 量 范 围 越 罕 ， 稳 定性 也 往往 
越 差 。 

3) 传感器 的 分 辨 力 。 分 辨 力 是 指 传 感 器 可 能 感受 到 的 被 测量 的 最 小 变化 的 能 力 。 也 就 
是 说 ， 如 果 输 入 量 从 某 一 非 零 值 缓慢 地 变化 ， 当 输入 变化 值 未 超过 某 一 数值 时 ， 传 感 器 的 输 
出 不 会 发 生变 化 ， 即 传感器 对 此 输入 量 的 变化 是 分 辨 不 出 来 的 。 只 有 当 输 入 量 的 变化 超过 分 
辩 力 时 ， 其 输出 才 会 发 生变 化 。 

通常 传感器 在 满 量程 范围 内 各 点 的 分 辨 力 并 不 相同 ， 因 此 常用 满 量程 中 能 使 输出 量 产 生 
阶 牙 变化 的 输入 量 中 的 最 大 变化 值 作为 衡量 分 辨 力 的 指标 。 上 述 指标 若 用 满 量程 的 百分比 表 
示 ， 则 称 为 分 辩 率 。 

4) 传感器 的 量程 。 量 程 是 指 传感器 适用 的 测量 范围 。 每 个 传感器 都 有 其 测量 范围 ， 如 
超出 其 测量 范围 将 不 可 靠 ， 甚 至 损坏 传感器 。 

5) 传感器 的 迟滞 。 传 感 器 在 标定 过 程 中 加 载 输 
出 与 介 载 输出 之 间 的 不 重合 性 称 为 迟滞 。 传 感 器 的 
迟滞 特性 如 图 6-3 所 示 ， 它 一 般 是 由 实验 方法 测 得 。 
迟 济 误 差 一 般 以 满 量 程 输出 的 百分数 表示 ， 即 yn = 
+£(1/2) (Apw /yrs) X100%, 

(2) 传感器 的 动态 特性 ”所 谓 动态 特性 ， 是 指 
传感器 在 输入 变化 时 ， 它 的 输出 的 特性 。 在 实际 工 
作 中 ,传感器 的 动态 特性 常用 它 对 某 些 标准 输入 信 
号 的 响应 来 表示 。 这 是 因为 传感器 对 标准 输入 信和 号 图 6-3 传感器 的 迟 清 特 性 
的 响应 容易 用 实验 方法 求 得 ， 并 且 它 对 标准 输入 信 
号 的 响应 与 它 对 任意 输入 信和 号 的 响应 之 间 存 在 一 定 的 关系 ， 往 往 知 道 了 前 者 就 能 推定 后 者 。 
最 常用 的 标准 输入 信号 有 阶 跃 信 号 和 正弦 信和 号 两 种 ， 所 以 传 感 凯 的 动态 特性 也 常用 阶 跃 响应 





S 












































5 





132 


第 6 章 “” 机 器 人 控制 系统 | 





和 频率 响应 来 表示 。 
6. 2.2 机 器 人 内 部 传感器 


内 部 传 感 大 是 用 于 测量 机 器 人 上 自身 状态 的 功能 元 件 。 内 部 传 感 融 的 主要 目的 是 对 自身 的 
运动 状态 进行 检测 ， 即 检测 机 器 人 各 个 关节 的 位 移 、 速 度 和 加 速度 等 运动 参数 ， 为 机 器 人 的 
控制 提供 反馈 信号 。 机 器 人 内 部 传感器 主要 测量 运动 学 和 力学 参数 ， 使 机 顺 人 能 够 按照 规定 
的 位 置 、 轨 迹 和 速度 等 参数 进行 工作 ， 感 知 自己 的 状态 并 加 以 调整 和 控制 。 内 部 传感器 通常 
由 位 置 传感器 、 角 度 传 感 器 、 速 度 传感器 和 加 速度 传 感 融 等 组 成 。 

机 器 人 使 用 的 内 部 传感器 主要 包括 位 置 、 位 移 、 速 度 和 加 速度 等 传感器 。 

1. 位 置 传感器 

位 置 传感器 主要 是 对 机 器 人 关节 的 位 置 和 位 移 进 行 检测 。 

检测 给 定 的 位 置 ， A 这 种 方法 用 于 检测 机 器 人 的 起 始 原 点 、 
终点 位 置 或 某 个 确定 的 位 置 。 给 定位 置 检测 常用 的 检测 元 件 有 微型 开关 、 光 电 开 关 等 。 

0 
( 常 闭 ) 或 接 通 〈 常 开 ) 并 向 控制 回路 发 出 动作 信号。 

限 位 开关 就 是 用 以 限定 机 械 设备 的 运动 极限 位 置 的 电气 开关 。 这 种 开关 有 接触 式 和 非 接 
触 式 两 种 。 

接触 式 的 比较 直观 ， 在 机 械 设备 的 运动 部 件 上 安装 行程 开关 ， 与 其 相对 运动 的 固定 点 上 
安装 极限 位 置 的 挡 块 ， 或 者 是 相反 安装 位 置 。 当 行程 开关 的 机 械 触 头 碰 上 挡 块 时 ,切断 了 
(或 改变 了 ) 控制 电路 ,机械 就 停止 运行 或 改变 运行 。 由 于 机 械 的 惯性 运动 ， 这 种 行程 开关 
有 一 定 的 “ 超 行程 ”以 保护 开关 不 受 损坏 。 

非 接触 式 的 形式 很 多 ， 常 见 的 有 干 千 管 、 光 电 式 和 感应 式 等 ， 这 几 种 形式 在 电梯 中 都 能 
够 见 到 。 当 然 还 有 更 多 的 先进 形式 。 

2) 光电 开关 。 光 电 开 关 是 通过 把 发 光 强 度 的 变化 转换 成 电信 号 的 变化 来 实现 控制 的 。 
光电 开关 在 一 般 情 况 下 ， 由 发 送 需 、 接 收 融 和 检测 电路 三 部 分 构成 。 

光电 开关 的 原理 是 根据 投 光 需 发 出 的 


光束 ， 被 物体 阻 断 或 部 分 反射 ， 受 光 器 最 
终 据 此 做 出 判断 反应 ， 起 动 开 关 作用 。 其 | 
原理 图 如 图 6-4 所 示 。 
光电 开关 主要 用 于 非 接触 性 检测 ， 精 (HT 加 | 二 


度 达 0. 5mm。 

2. 位 置 、 角 度 测量 传感器 

测量 机 器 人 关节 线 位 移 和 角 位 移 的 传 感 顺 是 机 器 人 位 置 反馈 控制 中 必 不 可 少 的 元 件 。 常 
用 的 有 电位 器 、 旋 转变 压 器 和 编码 器 等 。 其 中 编码 器 既 可 以 检测 直线 位 移 ， 又 可 以 检测 角 
位 移 。 

(1) 编码 器 ”编码 器 是 将 信号 或 数据 进行 编制 、 转 换 为 可 用 以 通信 、 传 输 和 存储 的 信和 号 
形式 的 设备 ， 其 测量 输出 的 信号 为 数字 脉冲 ， 可 以 测量 直线 位 移 也 可 以 测量 角 人 位移。 编码 器 
测量 范围 大 ， 检 测 精度 高 ， 在 机 器 人 的 位 置 检测 及 其 他 工业 领域 得 到 了 广泛 应 用 。 机 器 人 设 
计时 ， 把 该 传感器 安装 在 机 器 人 各 关节 的 转轴 上 ， 用 来 检测 各 关节 转 过 的 角度 。 按 照 读 出 方 
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图 6-4 光电 开关 的 原理 图 
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式 编 码 器 可 分 为 接触 式 和 非 接触 式 两 种 ; 按照 工作 原理 编码 器 可 分 为 增 量 式 和 绝对 式 两 类 。 
增 量 式 编码 器 是 将 位 移 转 换 成 周期 性 的 电信 号 ， 再 把 这 个 电信 号 转变 成 计数 脉冲 ， 用 脉冲 的 
个 数 表示 位 移 的 大 小 。 绝 对 式 编码 咒 的 每 一 个 位 置 对 应 一 个 确定 的 数字 码 ， 因 此 它 的 示 值 只 
与 测量 的 起 始 和 终止 位 置 有 关 ， 而 与 测量 的 中 间 过 程 无 关 。 目 前 机 带 人 较为 常用 的 是 光电 式 
编码 器 。 

光电 编码 融 由 发 光 元 件 、 聚 光 镜 、 漏 光盘 、 光 栏 板 和 光敏 管 等 构成 。 灯 泡 发 出 的 光线 经 
过 聚 焦 后 变 成 平行 光束 ， 当 漏 光 盘 上 的 条 纹 与 光 栏 板 上 的 条 纹 重合 时 ， 光 敏 管 便 接收 一 次 光 
的 信号 并 计数 ， 由 此 可 以 测试 关节 转 过 的 角度 ， 旋 转 式 光电 编码 需 的 工作 原理 如 图 6-5 所 
示 。 直 线 式 增 量 编码 器 的 工作 原理 与 旋转 式 相同 ， 其 工作 原理 如 图 6-6 所 示 。 





















































图 6-5 光电 编码 器 工作 原理 图 


























1 一 光源 2 一 聚 光 镜 3 一 漏 光 盘 4 一 光敏 管 5 一 光 栏 板 


(2) 旋转 变压器 ”旋转 变压器 又 称 为 
分 解 器 ， 是 一 种 控制 用 的 微型 电动 机 ， 它 
将 机 械 转 角 变 换 成 与 该 转角 呈 某 一 函数 关 
系 的 电信 号 的 一 种 间接 测量 装置 。 在 结构 
上 与 二 相 线 绕 式 异步 电动 机 相似 ， 由 定子 
和 转子 组 成 。 定 子 绕组 为 变压器 的 初级 ， 光源 
转子 绕组 为 变压器 的 次 级 。 励 磁 电 压 接 到 图 6-6 简单 直线 式 增 量 编码 器 工作 原理 图 
转子 绕组 上 ， 感 应 电动 势 由 定子 绕组 
输出 。 

旋转 变压器 原理 如 图 6-7 所 示 。 转 子 转动 引起 磁 通 量 旋转 ， 在 二 次 绕组 产生 变化 的 电 
压 ， 从 而 可 以 用 来 测量 角 位 移 。 
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图 6-7 ”旋转 变压器 原理 图 
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在 图 6-7 中 ， 设 该 旋转 变压器 空 载 ， 即 转子 输出 绕组 和 定子 交 轴 绕组 开路 ， 仅 将 定子 绕 
组 加 交流 励磁 电压 Dn 。 那 么 气 隙 中 将 产生 一 个 脉 振 磁 感应 强度 瑟 ， 其 轴线 在 定子 励磁 绕 


组 的 轴线 上 。 据 自 整 角 机 的 电磁 理论 ， 磁 感应 强度 B ,将 在 二 次 即 转子 的 两 个 输出 绕组 中 感 
应 出 变 压 带 电动 势 。 





在 余弦 输出 绕组 Z1-2Z, 中 感应 的 电动 势 为 
Er =ErcosO (6-1) 

在 正弦 输出 绕组 Z;-2Z 中 感应 的 电动 势 为 
Er=Ercos(0+90°)= -EpsinO (6-2) 


其 中 ,En 为 转子 输出 绕组 轴线 与 定子 励磁 绕组 轴线 重合 时 ， 磁 通 B ,在 输出 绕组 中 感应 
的 电动 势 。 若 假设 By 在 励磁 绕组 D1-D, 中 感应 的 电动 势 为 一 ， 则 旋转 变压器 的 变 比 为 





E, W 
J (6-3) 
Ep, W, 
式 中 ”了 酌 一 一 输出 绕组 的 有 效 臣 数 ; 
W, 一 一 励磁 绕组 的 有 效 硬 数 。 
将 式 (6- 3) 代入 式 (6-1)、 式 (6-2) 得 
后 =k Epcos0 (6.4) 
Em=-k Epsing 


与 变压器 类 似 ， 可 忽略 定子 励磁 绕组 的 电阻 和 漏电 抗 ， 则 5 = Un ， 空 载 时 转子 输出 绕 
组 电动 势 等 于 电压 ， 于 是 式 (6-4) 可 写成 
UVai=AuUncosb 
ee 
上 式 表明 当 电 源 电 压 不 变 时 ， 输 出 电动 势 与 转子 转角 9 有 严格 的 正 、 余 弦 关 系 ， 因 此 可 
用 来 测量 角 位 移 。 旋 转变 压 器 结构 简单 ， 动 作 灵 敏 ， 对 环境 无 特殊 要 求 ， 维 护 方 便 ， 输 出 信 
号 幅度 大 ， 抗 干扰 性 强 ， 工 作 可 靠 。 
3. 速度 传感器 
速度 传感器 是 机 吉 人 党 用 的 内 部 传感器 之 一 。 速 度 、 角 速度 的 测量 也 是 驱动 器 反馈 控制 
中 必 不 可 少 的 环节 。 可 利用 前 面 所 述 的 编码 器 测量 ， 也 可 用 测速 发 电机 测量 。 
编码 需 测 速 原 理 : 在 机 器 人 闭环 伺服 系统 中 ， 编 码 需 的 反馈 脉冲 个 数 和 系统 所 走 位 置 的 
多 少 成 正比 。 对 任意 给 定 的 角 位 移 ， 编 码 器 将 产生 确定 数量 的 脉冲 信号 ， 通 过 统计 指定 时 间 
内 脉冲 信号 的 数量 ， 能 计算 出 相应 的 角速度 。 
测速 发 电机 是 一 种 模拟 式 速 度 传感器 ， 从 工作 原理 上 讲 ， 它 属于 “发 电机 ”的 范畴 。 
测速 发 电机 是 一 种 测量 转速 的 微型 发 电机 ， 它 把 输入 的 机 械 转速 变换 为 电压 信号 输出 ， 并 要 
求 输出 的 电压 信号 与 转速 成 正比 ， 即 


(6-5) 

















Uyz=hkn (6-6) 
式 中 Us 一 一 测速 发 电机 的 输出 电压 (V); 
测速 发 电机 的 转速 (r/min); 
一 一 比例 系数 。 
测速 发 电机 分 为 直流 测速 发 电机 和 交流 测速 发 电机 两 大 类 。 
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(1) 直流 测速 发 电机 ”直流 测速 发 电机 实际 就 是 一 种 微型 直流 发 电机 ， 按 定子 磁极 的 励 
磁 方 式 分 为 电磁 式 和 永 磁 式 。 直 流 测速 发 电机 的 输出 电压 与 转速 要 严格 保持 正比 关系 ， 这 在 
实际 中 是 难以 做 到 的 ， 直 流 测速 发 电机 输出 的 是 一 个 脉动 电压 ， 其 交 变 分 量 对 速度 反馈 控制 
系统 、 高 精度 的 解 算 装置 有 较 明 显 的 影响 。 

(2) 交流 测速 发 电机 ”交流 异步 测速 发 电机 与 交流 伺服 电动 机 的 结构 相似 ， 其 转子 结构 
有 笼 型 的 ， 也 有 杯 型 的 ， 在 目 动 控制 系统 中 多 用 空心 杯 转子 异步 测速 发 电机 。 

交流 同步 测速 发 电机 因 感 应 电势 频率 随 转速 而 变 ， 致 使 发 电机 本 身 的 阻抗 及 负载 阻抗 均 
随 转速 而 变化 ， 因 此 ， 输 出 电压 不 再 与 转速 成 正比 关系 。 故 同步 测速 发 电机 应 用 较 少 。 

由 测速 发 电机 作为 速度 反馈 元 件 构成 的 机 器 人 速度 闭环 系统 中 ,测速 发 电机 的 转子 与 机 
器 人 关节 驱动 电动 机 的 尾 轴 相 连 ， 可 以 测 出 机 器 人 运动 过 程 中 的 关节 转动 速度 。 因 此 ， 测 速 
发 电机 在 机 器 人 控制 系统 中 得 到 了 广泛 应 用 。 


6.2.3 机 器 人 外 部 传感器 


机 器 人 要 能 在 变化 的 作业 环境 中 完成 作业 任务 ， 就 必须 具备 类 似 于 人 类 对 环境 的 感 
觉 功 能 。 将 机 器 人 用 于 对 工作 环境 变化 的 检测 的 传感器 称 为 外 部 传感器 ， 有 时 也 称 为 环 
境 感 觉 传感器 或 环境 感觉 器 官 。 外 部 传感器 主要 用 来 检测 机 咒 人 所 处 环境 及 目标 状况 ， 
如 是 什么 物体 ， 离 物体 的 距离 有 多 远 ， 抓 取 的 物体 是 否 滑落 等 。 从 而 使 得 机 器 人 能 够 与 
环境 发 生 交 互 作 用 ， 并 对 环境 具有 自我 校正 和 适应 能 力 。 目 前 ， 机 顺 人 常用 的 环境 感觉 技 
术 主 要 有 视觉 、 听 觉 、 触 觉 和 力 觉 等 。 广 义 来 讲 ， 机 器 人 外 部 传感器 就 是 具有 人 类 五 官 的 感 
知 能 力 的 传 感 融 。 

外 界 检测 传 感 咒 通常 包括 触觉 、 接 近 觉 、 视 觉 、 听 觉 、 嗅 党 和 味觉 等 传 感 需 。 

在 工业 应 用 中 ， 控 制 机 器 人 精确 地 去 抓 取 在 某 一 参考 位 置 上 的 工件 ， 并 非 一 件 容易 的 
事 ， 由 于 工件 本 身 的 变形 及 其 他 不 确定 的 因素 ， 最终 将 需要 进行 相对 位 置 姿 态 的 调整 ， 通 常 
情况 下 ， 移 动机 顺 人 比 移 动工 件 更 容易 些 ， 可 以 通过 安装 在 机 器 人 末端 上 的 测 距 传感器 来 解 
决 。 测 距 传感器 在 移动 机 器 人 上 应 用 较 多 。 机 器 人 测 距 传感器 一 般 都 采用 主动 法 直接 获取 上 距 
离 信息 ， 用 于 对 机 器 人 进行 实时 的 控制 和 规划 。 

机 器 人 测 距 传感器 大 致 可 分 为 两 种 : 其 测量 距离 从 几 十 厘米 到 数 米 远 的 称 为 距离 觉 传 感 
器 ; 探测 距离 为 零点 几 毫 米 到 几 十 毫米 的 称 为 接近 觉 传感器 。 测 距 传感器 的 作用 如 下 : 由 发 
现 前 方 障碍 物 ， 限 制 机 器 人 的 运动 范围 ， 以 避免 与 障碍 物 发 生 碰撞 ; @ 在 接触 对 象 前 得 到 必 
要 的 信息 ， 如 与 物体 的 相对 距离 、 相 对 倾角 ， 以 便 为 后 续 运 动 规划 做 准备 ; @@ 获 取 对 象 表面 
各 点 间 的 距离 ， 从 而 得 到 有 关 对 象 表面 形状 的 信息 。 

按照 测 距 的 原理 不 同 ， 机 器 人 测 距 传感器 可 分 为 : 接触 式 传 感 咒 、 感 应 式 测 距 传感器 、 
电容 式 测 距 传 感 顺 、 超 声 测 距 传 感 顺 、 光 电 式 测 距 传 感 咒 、 气 压 式 测 距 传 感 器 、 微 波 和 无 线 
电波 测 距 传感器 等 类 型 。 

(1) 接触 式 传感器 ” 测 距 传 感 融 一 般 都 采用 非 接触 测量 原理 ， 而 这 里 所 考虑 的 机 械 的 接 
触 式 传感器 与 触觉 不 同 : 它 与 昆虫 的 触须 类 似 ， 在 机 名人 上 通过 以 微 动 开关 和 相应 的 机 械 装 
置 〈 探 头 、 探 针 等 ) 相 结 合 来 实现 一 般 接触 测量 距离 的 作用 。 这 种 触须 式 的 传 感 带 可 以 安 
六 在 移动 机 器 人 的 四 周 ， 用 以 发 现 外 界 环 境 中 的 障碍 物 。 图 6-8 所 示 为 接触 式 传感器 原 
理 图 。 
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(2) 感应 式 测 距 传 感 器 ”感应 式 测 距 传 
感 器 主要 有 三 种 类 型 ,它们 分 别 基 于 电磁 感 
应 、 堆 尔 效应 和 电 涡 流 原理 ， 仅 对 铁 磁 性 材 
料 起 作用 ， 用 于 近 距 离 、 小 范围 内 的 测量 。 

1) 电磁 感应 测 距 传感器 。 这 种 传感器 的 
核心 由 线圈 和 永久 磁铁 构成 ， 如 图 6-9 所 示 。 
当 传 感 器 远离 铁 磁 性 材料 时 ， 永 久 磁 铁 的 磁 
力 线 如 图 6-9a 所 示 ; 当 传 感 器 靠近 铁 磁 性 材 图 6-8 ”接触 式 传感器 原理 图 
料 时 ,引起 永久 磁铁 磁力 线 的 变化 ， 从 而 在 
线圈 中 产生 电流 ， 如 图 6- 9b 所 示 。 这 种 传感器 在 与 被 测 物体 相对 静止 的 条 件 下 ， 由 于 磁力 
线 不 发 生变 化 ， 因 而 线圈 中 没有 电流 ， 因 此 这 种 传感器 只 是 在 外 界 物体 与 之 产生 相对 运动 时 
才能 产生 输出 。 由 于 随 着 距离 的 增 大 ， 输 出 信号 明显 减弱 ， 因 而 这 种 类 型 的 传感器 只 能 用 于 
短 距离 的 测量 ,一 般 仅 为 零点 几 毫 米 。 



































磁力 线 办 


图 6-9 电磁 感应 测 距 传感器 永久 磁铁 磁力 线 的 变化 


2) 电 涡流 测 距 传感器 。 根 据 法 拉 第 电磁 感应 原理 ， 块 状 金属 导体 置 于 变化 的 磁场 中 或 
在 磁场 中 做 切割 磁力 线 运动 时 (与 金属 是 否 块 状 无 关 ， 且 切割 不 变化 的 磁场 时 无 涡流 )， 导 
体内 将 产生 呈 涡 旋 状 的 感应 电流 ， 此 电流 称 为 电 涡流 ， 以 上 现象 称 为 电 涡流 效应 。 而 根据 电 
涡流 效应 制 成 的 传感器 称 为 电 涡 流 式 传感器 。 电 涡 
流 测 距 传 感 絮 的 形式 最 简单 ， 只 包括 一 个 线圈 ， 如 
图 6-10 所 示 。 线 圈 中 通 人 交 变 电流 ， 当 传感器 与 外 
界 导 体 接近 时 ， 导 体 中 产生 感应 电流 ， 传 感 器 与 外 
界 导 体 的 距离 变化 能 够 引起 导体 中 所 产生 感应 电流 
的 变化 ， 通 过 适当 的 检测 电路 ， 可 从 线圈 中 耗 散 功 
率 的 变化 得 出 传感器 与 外 界 物体 之 间 的 距离 。 这 类 
传感器 的 测 距 范围 在 零 到 十 几 毫 米 之 间 ， 分 辩 率 可 
达 满 量程 的 0. 1% 。 

按照 电 涡 流 在 导体 内 的 贯穿 情况 ， 分 为 高 频 反 
射 式 电 涡 流传 感 器 和 低频 透射 式 电 涡流 传感器 。 电 涡流 传感器 具有 可 靠 性 好 、 测 量 范 转 












































图 6-10 电 涡 流 测 距 传感器 工作 原理 
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灵敏 度 高 、 分 辩 率 高 、 响 应 速度 快 、 抗 干扰 力 强 、 不 受 油 污 等 介质 的 影响 、 结 构 简 单 等 优 
点 ， 在 机 器 人 状态 的 在 线 监 测 中 得 到 广泛 应 用 。 

3) 堆 尔 效应 测 距 传感器 。 霍 尔 传感器 是 根据 霍 尔 效 应 制作 的 一 种 磁场 传感器 。 图 6-11 
所 示 是 采用 永久 磁铁 和 特定 导体 构成 的 霍 尔 传感器 ， 当 传感器 远离 被 测 导体 时 ， 在 特定 导体 
上 作用 有 较 强 的 磁场 ， 当 传感器 与 被 测 导 体 很 近 时 ， 特 定 导 体 上 磁场 变 弱 ， 磁 场 的 变化 将 引 
起 特定 导体 前 后 两 端 电压 的 变化 ,电压 的 大 小 与 位 移 大 小 成 正比 ， 基 于 以 上 原理 即 可 测量 
距离 。 








| 
; 传感器 























图 6-11 和 堆 尔 效应 传感器 与 永久 磁体 组 合 使 用 的 工作 原理 


(3) 超声 测 距 传感器 “超声 波 距 离 伟 
感 器 用 于 机 器 人 对 周转 物体 的 存在 与 距离 
的 探测 。 尤 其 对 移动 式 机 器 人 ， 安 装 这 种 pe 
传感器 可 随时 探测 前 进 道路 上 是 否 出 现 障 陶 次 传感器 -此 
碍 物 ， 以 免 发 生 碰撞 。 图 6-12 所 示 为 超声 
接近 觉 传感器 。 

超声 波 发 生 器 有 压 电 式 、 电 磁 式 及 磁 i 
滞 伸 缩 式 等 。 在 检测 技术 中 最 常用 的 是 压 
电 式 。 


6.3 机 器 人 运动 控制 系统 























图 6-12 ”超声 接近 觉 传 感 需 


6. 3.1 机 器 人 控制 系统 


机 器 人 控制 系统 按 控 制 方式 可 分 为 三 种 结构 ,集中 控制 、 主 从 控制 和 分 布 式 控制 。 

集中 控制 就 是 使 用 一 台 功 能 较 强 的 计算 机 实现 全 部 控制 功能 ， 在 早期 的 机 器 人 中 普遍 采 
用 这 种 结构 。 传 统 的 机 器 人 控制 器 采用 MCU 作为 控制 芯片 ， 其 运算 速度 和 处 理 能 力 难以 满 
足 日 益 复 杂 的 机 器 人 控制 。 随 着 机 器 人 功能 的 增加 ， 其 控制 过 程 中 也 随 之 增加 了 许多 计算 
(如 坐标 变换 等 )， 因 此 这 种 集中 式 控制 结构 已 经 不 能 满足 需要 ， 取 而 代 之 的 是 主 从 式 控制 
和 分 布 式 控制 结构 。 由 于 机 器 人 的 控制 过 程 中 涉及 大 量 的 坐标 变换 和 插 补 运算 以 及 较 低层 的 
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实时 控制 ， 所 以 ， 目 前 的 机 需 人 控制 系统 在 结构 上 大 多 数 采 用 分 层 结构 的 微型 计算 机 控制 系 
统 ， 通 常 采 用 的 是 两 级 计算 机 伺服 控制 系统 。 上 一 级 主 控制 计算 机 负责 整个 系统 管理 以 及 坐 
标 变换 和 轨迹 、 搬 补 运算 等 ;下 一 级 由 许多 微 处 理 器 组 成 ， 每 一 个 微 处 理 需 控制 一 个 关节 运 
动 ， 它 们 并 行 地 完成 控制 任务 。 因 而 能 提高 整个 控制 系统 的 工作 速度 和 处 理 能 力 。 这 些微 处 
理 器 和 主 控 机 联系 是 通过 总 线形 式 的 紧 斐 合 。 分 布 式 结构 是 开放 性 的 ， 可 以 根据 需要 增加 更 
多 的 处 理 咒 ， 以 满足 传感器 处 理 和 通信 的 需要 。 这 种 结构 功能 强 、 速 度 快 ， 是 当今 机 名 人 控 
制 系统 的 主流 。 图 6-13 所 示 是 机 器 人 控制 系统 的 工作 过 程 : 主 控 计 算 机 接 到 工作 人 员 输 入 
的 作业 指令 后 ， 首 先 分 析 解 释 指 令 ， 确 定 机 器 人 手 部 的 运动 参数 ， 然 后 进行 运动 学 、 动 力学 
和 捅 补 运算 ， 最 后 得 出 机 器 人 各 个 关节 的 协调 运动 参数 。 这 些 参数 经 过 通信 线路 输出 到 伺服 
控制 级 ， 作 为 各 个 关节 伺服 控制 系统 的 给 定 信号 。 关 节 驱 动 器 将 此 信号 D-A 转换 后 驱动 各 
个 关节 产生 协调 运动 ， 并 通过 传感器 将 各 个 关节 的 运动 输出 信号 反馈 回 伺服 控制 级 计算 机 形 
成 局 部 闭环 控制 ， 从 而 更 加 精确 地 控制 机 器 人 手 部 在 空间 的 运动 。 
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一 级 (上 位 机 ) 
微型 计算 机 


数据 存储 


























局 部 反馈 








图 6-13 机 器 人 控制 系统 的 工作 过 程 














在 控制 过 程 中 ， 工 作 人 员 可 直接 监视 机 器 人 的 运动 状态 ， 也 可 从 显示 天 等 输出 装置 上 得 
到 有 关机 融 人 运动 的 信息 。 下 面 从 三 个 方面 介绍 机 器 人 的 控制 系统 。 
1. 机 器 人 控制 系统 的 硬件 组 成 














人 机 交互 
数学 运算 
立 机 ， 个 人 入 \ 型 1 
六 利器 | 上 位 机 : 个 人 微机 、 小 型 计算 机 1 亩 信 
数据 存储 


下 位 机 : 单片机 、 运 动 控制 融 一 伺服 驱动 
内 部 传 感 咒 : 自身 关节 运动 状态 检测 











签 测 优 感 融 ( 外 部 传感器 外 部 环境 参数 变化 检测 
上 位 机 通常 采用 个 人 微机 或 小 型 计算 机 ， 其 具体 功能 如 下 : 
人 机 交互 功能 ， 人 通过 上 位 机 将 作业 任务 给 机 器 人 ， 同 时 机 器 人 将 结果 反馈 回来 ， 即 人 
与 机 器 人 之 间 的 交流 。 


数学 运算 : 机 器 人 运动 学 、 动 力学 和 数学 搬 补 运算 。 机 融 人 运动 学 的 正 运算 和 逆 运 算是 
其 中 最 基本 的 部 分 。 对 于 具有 连续 轨迹 控制 功能 的 机 器 人 来 说 ， 还 需要 有 直角 坐标 轨迹 搬 补 
功能 和 一 些 必要 的 函数 运算 功能 。 在 一 些 高 速度 、 高 精度 的 机 器 人 控制 系统 中 ， 系 统 往往 还 
要 完成 机 器 人 动力 学 模型 和 复杂 控制 算法 等 运算 功能 。 

通信 功能: 与 下 位 机 进行 数据 传送 和 相互 交换 。 

数据 存储 : 存储 编制 好 的 作业 任务 程序 和 中 间 数 据 。 
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系统 的 管理 功能 : 具有 对 外 部 环境 (包括 作业 条 件 ) 的 检测 和 感觉 功能 ， 系 统 的 监控 
与 故障 诊断 功能 。 

下 位 机 通常 采用 单片机 或 运动 控制 器 ， 其 具体 功能 为 伺服 驱动 控制 。 接 收 上 位 机 的 关节 
运动 参数 信号 和 传感器 的 反馈 信号 ， 并 对 其 进行 比较 ， 然 后 经 过 误差 放大 和 各 种 补偿 ， 最 终 
输出 关节 运动 所 需 的 控制 信号 。 

由 单片机 组 成 下 位 机 的 二 级 控制 系统 框图 如 图 6-14 所 示 。 


















































电动 机 。 码 盘 
区 (DO 
[as 会 | 和 全 人) 测速 机 | 
CRT 机 内 . - 
一 级 控制 | 二 级 控制 2 伺服 系统 | 














图 6-14 由 单片机 组 成 下 位 机 的 二 级 控制 系统 框图 


2. 运动 控制 器 构成 的 控制 系统 

机 器 人 的 下 位 机 也 可 以 由 运动 控制 带 组 成 。 一 般 的 伺服 控制 系统 包括 伺服 执行 元 件 
(伺服 电动 机 )、 伺 服 运动 控制 缮 、 功 率 放大 器 (又 称 为 伺服 驱动 器 )、 位 置 检测 元 件 等 。 何 
服 运动 控制 右 的 功能 是 实现 对 伺服 电动 机 的 运动 控制 ,包括 力 、 人 位置、 速度 等 的 控制 。 某 些 
机 器 人 系统 把 各 个 轴 的 伺服 运动 控制 器 和 功率 放大 器 集成 组 装 在 控制 柜 内 ， 如 Motoman 机 器 
人 ， 这样 实际 上 相当 于 由 一 台 专 用 计算 机 控制 。 

然而 ， 随 着 芯片 集成 技术 和 计算 机 技术 的 发 展 ， 专 用 运动 控制 芯片 和 运动 控制 卡 越 来 越 
多 地 作为 机 器 人 的 运动 控制 锅 。 这 两 种 形式 的 伺服 运动 控制 器 控制 方便 灵活 ， 成 本 低 ， 都 以 
通用 PC 为 平台 ,借助 PC 的 强大 功能 来 实现 机 器 人 的 运动 控制 。 前 者 利用 专用 运动 控制 蕊 
片 与 PC 总 线 组 成 简单 的 电路 来 实现 ; 后 者 直接 做 成 专用 的 运动 控制 卡 。 这 两 种 形式 的 运动 
控制 器 内 部 都 集成 了 机 器 人 运动 控制 所 需 的 许多 功能 ， 有 专用 的 开发 指令 ， 所 有 的 控制 参数 
都 可 由 程序 设 定 ， 使 机 器 人 的 控制 变 得 简单 ， 易 于 实现 。 

运动 控制 器 都 需 从 主机 (PC) 接收 控制 命令 ， 从 位 置 传感器 接收 位 置信 息 ， 向 伺服 电 
动机 功率 驱动 电路 输出 运动 命令 。 对 于 伺服 电动 机 位 置 闭环 系统 来 说 ， 运 动 控 制 玫 主 要 完成 
了 位 置 环 的 作用 ， 可 称 为 数字 伺服 运动 控制 器 ， 适 用 于 包括 机 器 人 和 数控 机 床 在 内 的 一 切 
交 、 直 流 和 步 进 电 动机 伺服 控制 系统 。 

专用 运动 控制 器 的 使 用 使 得 原来 由 主机 做 的 大 部 分 计算 工作 由 运动 控制 器 内 的 芯片 来 完 
成 ， 使 控制 系统 硬件 设计 简单 ， 与 主机 之 间 的 数据 通信 量 减 少 ， 解 决 了 通信 中 的 瓶颈 问题 ， 
提高 了 系统 效率 。 

运动 控制 器 由 专门 广 家 生产 ， 其 可 靠 性 高 。 图 6-15 所 示 为 Delta Tau Data System 公司 生 
产 的 一 款 运 动 控制 器 。 核 心 由 ADSP2181 数字 信和 号 处 理 器 及 其 外 围 部 件 组 成 ， 可 以 实现 高 性 
能 的 控制 计算 ,同步 控制 多 个 运动 轴 ， 实 现 多 轴 协 调运 动 。 应 用 领域 包括 机 带 人 、 数 控 机 
床 等 。 
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运动 控制 器 以 PC 为 主机 ， 提 供 标准 的 ISA 、 
PCI 及 通用 的 串口 总 线 和 数字 IO 接口。 运动 控制 
器 提供 高 级 语言 函数 库 和 Windows 动态 链接 库 ， 
可 以 实现 复杂 的 控制 功能 。 用 户 能 够 将 这 些 控制 
函数 与 自己 控制 系统 所 需 的 数据 处 理 、 界 面 显示 、 
用 户 接口 等 应 用 程序 模块 集成 在 一 起 ， 构 建 符合 
特定 应 用 要 求 的 控制 系统 ， 以 适应 各 种 应 用 领域 
的 要 求 。 运 动 控制 器 组 成 的 控制 系统 框图 如 图 6-16 
所 示 。 图 6-15 ”运动 控制 器 
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图 6-16 ”控制 系统 示意 图 





3. 机 器 人 控制 系统 的 软件 组 成 

[计算 机 操作 系统 一 个 人 微机 、 小 型 计算 机 
系统 软件 | 系统 初始 化 程序 运动 控 

系统 初始 化 程序 一 单片机 、 运 动 控制 器 

动作 控制 软件 一 实时 动作 解释 执行 程序 
运算 软件 一 运动 学 、 动 力学 和 插 补 程序 
编程 软件 一 作业 任务 程序 、 编 制 环境 程序 
监控 软件 一 实时 监视 、 故 障 报警 等 程序 

机 器 人 中 应 用 最 为 广泛 的 是 机 械 手 (manipulation robots ) ， 这 种 机 器 人 能 够 模仿 和 再 现 
人 和 手 的 动作 。 机 器 人 分 为 自动 操作 式 、 交 互 式 、 自 主 式 三 种 。 

目前 的 机 器 人 大 多 属于 自动 操作 机 器 人 ， 这 类 机 器 人 控制 系统 又 可 分 为 三 种 类 型 : 

(1) 固定 程序 (或 编程 ) 控制 ”机 器 人 能 按照 预 编 的 固定 程序 ， 实 现 机 器 人 的 运动 。 

(2) 自 适 应 控制 ” 当 外 界 条 件 变 化 时 ， 为 保证 和 改善 控制 质量 ， 在 机 器 人 的 操作 过 程 
中 根据 其 状态 和 伺服 误差 的 反馈 ， 调 整 非 线性 的 控制 参数 ， 从 而 以 最 大 限度 地 减少 控制 误 
差 。 这 种 控制 系统 的 结构 和 参数 能 随时 间 和 条 件 自动 改变 ， 能 够 在 不 完全 确定 和 局 部 变化 的 
环境 中 ， 保 持 与 环境 的 自动 适应 ， 实 现 对 机 器 人 的 最 佳 控 制 。 





应 用 软件 
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(3) 人 工 智能 控制 ”事先 无 法 编制 运动 程序 ， 而 是 要 求 在 机 器 人 运动 过 程 中 根据 周围 
所 获得 的 具体 环境 信息 ， 实 时 确定 控制 策略 。 


6. 3.2 开放 式 控 制 系统 


现 阶段 机 器 人 的 控制 体系 结构 有 两 种 主要 形式 : 一 是 像 Motoman 和 ABB 等 比较 大 的 机 
器 人 制造 厂商 继续 使 用 自己 开发 的 专 有 控制 系统 ， 持 有 他 们 专 有 的 控制 体系 结构 ; 二 是 开放 
式 的 通用 控制 体系 结构 〈 如 现在 普遍 采用 的 基于 PC 机 的 运动 控制 结构 )。 由 斯 坦 福 人 工 管 
能 实验 室 研 发 的 机 器 人 开放 式 控 制 系统 获得 了 广泛 应 用 。 

开放 式 控 制 系统 是 一 个 动态 发 展 的 概念 ， 不 同 的 项 目 和 组 织 对 其 定义 也 有 差异 ， 但 总 结 
起 来 ,开放 式 机 器 人 控制 器 的 思想 应 具备 如 下 的 一 些 特点 : 

1) 使 用 基于 非 专用 计算 机 平台 (如 SUN、PC 等 ) 的 开发 系统 。 

2) 使 用 标准 的 操作 系统 (如 Windows、Unix) 和 标准 的 控制 语言 (如 C、C++ 等 ) 。 

3) 硬件 基于 标准 的 总 线 结构 ， 能 够 与 各 种 外 围 设备 和 传感器 连接 。 

4) 能 使 用 网 络 策略 ， 人 允许 工作 单元 控制 带 共 享 数据 库 ， 人 允许 远程 操作 。 

基于 以 上 思想 构造 的 控制 系统 具有 良好 的 互 换 性 和 可 移植 性 ， 用 户 可 以 实现 对 控制 器 的 
修改 、 更 换 和 改进 ; 控制 系统 具有 模块 化 特点 ， 这 能 够 降低 开发 成 本 ， 并 提高 系统 的 质量 和 
安全 性 能 ; 支持 扩展 功能 等 诸多 优点 。 开 放 式 的 控制 系统 是 机 器 人 控制 的 一 个 重要 发 展 
方向 。 















































6.4 机 器 人 运动 控制 系统 实例 分 析 


机 器 人 的 运动 控制 是 指 机 器 人 手 部 在 空间 从 一 点 移动 到 另 一 点 的 过 程 中 或 沿 某 一 轨迹 运 
动 时 ， 对 其 位 姿 、 速 度 和 加 速度 等 运动 参数 的 控制 。 

由 机 器 人 运动 学 可 知 ， 机 器 人 手 部 的 运动 是 由 各 个 关节 的 运动 引起 的 ， 所 以 控制 机 器 人 
手 部 的 运动 实际 上 是 通过 控制 机 器 人 各 个 关节 的 运动 实现 的 。 

机 器 人 手 部 的 控制 过 程 框图 如 图 6-17 所 示 。 根 据 机 器 人 作业 任务 中 要 求 的 手 部 的 运动 ， 
通过 运动 学 逆 解 和 数学 插 补 运算 得 到 机 器 人 各 个 关节 运动 的 位 移 、 速 度 和 加 速度 ， 再 根据 动 
力学 正解 得 到 各 个 关节 的 驱动 力 〈 矩 ) 。 机 器 人 控制 系统 根据 运算 得 到 的 关节 运动 状态 参数 
控制 驱动 装置 ， 驱 动 各 个 关节 产生 运动 ， 从 而 合成 手 在 空间 的 运动 ， 由 此 完成 要 求 的 作业 
任务 。 
























关节 位 移 、 
速度 、 加 速度 


图 6-17 机 器 人 手 部 的 控制 过 程 框图 
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控制 过 程 可 以 进一步 分 解 ， 如 图 6-18 所 示 。 其 具体 控制 步骤 为 : 

第 一 步 : 关节 运动 伺服 指令 的 生成 ， 即 将 机 器 人 手 部 在 空间 的 位 姿 变化 转换 为 关 节 变量 
随时 间 按 系 一 规律 变化 的 函数 。 这 一 步 一 般 可 离线 完成 。 

第 二 步 : 关节 运动 的 伺服 控制 ， 即 采用 一 定 的 控制 算法 跟踪 执行 第 一 步 所 生成 的 关节 运 
动 伺服 指令 ， 这 是 在 线 完成 的 。 


与 
















关节 位 移 、 
速度 、 加 速度 























第 二 步 





图 6-18 ”机 器 人 的 运动 控制 分 解 步骤 


6. 4.1 基于 PC 与 单片机 的 机 器 人 控制 系统 


考虑 机 絮 人 的 通用 性 ， 以 及 机 器 人 的 实际 特点 ,设计 的 机 絮 人 控制 系统 应 具有 开放 性 ， 
使 操作 者 可 以 直接 观察 各 个 关节 转动 的 运行 情况 ， 还 可 以 租 入 自己 设计 的 控制 软件 来 验证 算 
法 的 正确 性 和 控制 方式 的 有 效 性 。 所 以 设计 的 机 带 人 实验 平台 的 控制 系统 采用 分 布 式 控 制 结 
构 形 式 ; 针对 机 器 人 的 实际 特点 ， 并 从 经 济 方面 考虑 并 不 需要 配备 视觉 等 传感器 ， 就 能 满足 
工业 任务 的 要 求 。 机 器 人 控制 系统 框架 如 图 6-19 所 示 。 此 控制 系统 采用 上 位 机 (PC) 与 单 
片 机 控制 器 进行 两 级 控制 。 

选取 通用 PC 为 主 控制 器 ， 因 为 通用 PC 具有 成 本 低廉 、PC 技术 成 熟 、 可 靠 性 高 、 具 有 
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图 6-19 ”机 器 人 控制 系统 框架 
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开放 性 等 优点 。 开 发 人 员 可 以 选择 合适 的 软件 、 硬 件 ， 以 较 低 的 成 本 组 成 较 强 性 能 的 系统 ， 
而 且 方 便 进行 二 次 开发 。 由 于 PC 技术 的 飞速 发 展 和 其 产品 良好 的 兼容 性 ， 完 全 可 以 满足 任 
务 规划 层 和 协调 层 的 功能 要 求 。 

控制 系统 中 上 位 机 运行 机 器 人 控制 主 程序 ， 该 程序 为 采用 高 级 语言 (C++) 编写 的 模块 
化 的 机 器 人 控制 系统 。 提 供用 户 界面 接口 ， 完 成 作业 任务 规划 、 运 动 学 正解 、 运 动 学 逆 解 和 
坐标 变换 等 ， 按 规划 解 算 出 机 器 人 关节 目标 轨迹 ， 然 后 分 配给 单 关节 伺服 控制 模块 ， 完 成 对 
机 咒 人 各 个 关节 的 控制 功能 。 

二 级 机 (下 位 机 ) 是 以 AT89S52 单片机 为 主 控制 芯片 ， 以 性 能 优越 的 专用 运动 控制 芯 
片 LM629 为 控制 核心 组 成 电路 硬件 结构 简洁 的 伺服 位 置 控制 系统 。 该 运动 控制 芯片 内 部 集 
成 了 数字 式 运 动 控制 器 的 全 部 功能 ， 使 得 设计 一 个 快速 、 准 确 的 运动 控制 系统 变 得 容易 。 

机 器 人 的 分 布 式 控制 系统 中 ， 对 通信 方式 的 选择 至 关 重 要 ， 上 位 计算 机 和 下 位 各 关节 控 
制 器 间 的 通信 既 要 满足 硬件 连接 简单 、 扩 充 方 便 ， 又 要 满足 通信 的 高 可 靠 性 和 实时 性 。 本 设 
计 采 用 CAN (Controller Area Network) 总 线 作 为 通信 标准 ，CAN 总 线 是 一 种 有 效 支 持 分 布 
式 控制 和 实时 控制 的 串 行 通信 网 络 ， 与 一 般 的 通信 网 络 相 比 具 有 可 靠 性 高 、 实 时 性 和 灵活 性 
好 的 优点 ， 非 常 适合 作为 机 器 人 控制 系统 中 的 通信 方式 。 各 关节 控制 系统 和 上 位 PC 之 间 是 
各 自 独立 的 单元 ， 各 个 单元 之 间 基 于 CAN 总 线 建立 通信 网 络 ， 每 个 单元 作为 网 络 的 一 个 


二 
节点 。 





























6.4.2 控制 系统 的 硬件 实现 


根据 对 控制 系统 的 主要 功能 进行 分 析 ， 并 对 关键 器 件 进行 分 析 和 选 型 ， 可 针对 所 选 的 器 
件 绘制 电路 原理 图 ， 加 工 PCB 板 ， 如 图 6-20 所 示 。 


i 


























图 6-20 ”控制 系统 硬件 图 
1 一 CAN 驱动 器 82C250 2 一 CAN 控制 器 SJA1000 ”3 一 运动 控制 芯片 LM629 4 一 光 耦 合 器 6N137 
5 一 功率 驱动 芯片 LMD18200 ”6 一 电动 机 电源 输入 端子 7 一 电动 机 与 编码 器 接线 端子 8 一 5V 电源 输入 端子 
9 一 单片机 AT89C52 10 一 CAN 信号 线 端子 11 一 单片机 测试 点 端子 















































图 6-20 中 9 为 单片机 AT89C52， 是 下 位 机 控制 系统 的 主 控 芯片 ， 负 责 接 收 上 位 机 传输 
来 的 控制 命令 和 数据 ， 将 数据 发 送 给 LM629， 并 实时 从 LM629 读 取 各 关节 位 置信 息 ， 将 位 
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置信 息 通过 CAN 总 线 传输 给 上 位 机 显示 。 为 了 充分 利用 单片机 的 WO 口 ， 每 片 AT89C52 控 
制 三 个 关节 ， 也 就 是 控制 三 片 LM629。LM629 根据 单片机 传输 来 的 位 置 、 速 度 、 加 速度 、 
PID 参数 ， 生 成 梯形 轨迹 图 ， 并 输出 PWM 信号 ，PWM 信号 经 光 耦 合 器 件 6N137 隔离 后 ， 
传输 给 功率 驱动 芯片 LMD18200。LMD18200 根据 输入 PWM 信号 的 方向 和 幅 值 ， 输 出 正 向 或 
反 向 电流 ， 了 驱动 电 动机 正 向 或 反 向 运动 。LM629 实时 采集 电动 机 尾 轴 的 光电 编码 器 信号 ， 
记录 机 器 人 关节 的 相对 位 置 ， 当 关节 运动 到 预定 的 位 置 时 ，LM629 停止 输出 PWM 信号 ， 电 
动机 停止 运动 。 

为 了 便于 对 电路 板 进行 测试 ， 预 留 了 单片机 的 P2.5 和 P2.6 作为 测试 点 ， 图 6-20 中 ， 
11 为 预 留 的 测试 点 端子 。 有 了 测试 点 ， 可 以 在 软件 设计 遇 到 问题 时 ， 及 时 地 判断 出 是 硬件 
电路 的 问题 还 是 软件 信和 号 的 问题 ， 从 而 可 以 节省 调试 时 间 。 


6. 4. 3 LM629 运动 控制 处 理 器 功能 概述 


运动 控制 模块 是 硬件 控制 系统 的 核心 部 分 ， 它 不 但 负责 控制 电动 机 的 运行 状态 ， 通 过 传 
感 絮 接收 电动 机 的 反馈 数据 ， 同 时 可 以 基于 一 定 的 软件 计算 或 判断 来 减少 干扰 在 有 用 信号 中 
的 比重 ， 以 达到 减弱 或 消除 干扰 的 目的 。 在 所 设计 的 硬件 控制 系统 中 ,采用 LM629 作为 运 
动 控 制 模 块 的 核心 处 理 器 。 

LM629 是 美国 半导体 公司 生产 的 全 数字 专用 运动 控制 处 理 器 ， 用 来 控制 以 增 量 式 编码 
器 为 位 置 反馈 元 件 的 各 种 直流 或 无 刷 直流 电动 机 伺服 系统 或 其 他 伺服 系统 ， 具 有 很 强 的 实时 
运算 能 力 ; 通过 主 处 理 器 、 一 片 LM629 、 一 片 功率 驱动 器 、 一 台 直 流 电动 机 、 一 个 增 量 式 光 
电 编 码 器 即 可 构成 一 个 伺服 系统 。LM629 伺服 系统 框图 如 图 6-21 所 示 。 






























































LM629 1 
yn VODO 
| 


























图 6-21 LM629 伺服 系统 框图 





在 控制 系统 运行 时 ， 由 主 处 理 器 向 LM629 输出 PID 控制 参数 以 及 速度 、 加 速度 与 目标 
位 置 值 ， 每 个 采样 周期 都 用 这 些 值 计算 新 的 命令 和 位 置 并 送 入 求 和 点 ， 作 为 内 部 运算 处 理 器 
的 给 定点 ; 由 编码 器 来 反馈 电动 机 的 实际 位 置 ， 其 输出 信号 经 过 LM629 内 部 的 位 置 解码 器 
解码 后 作为 求 和 点 的 男 一 个 输入 点 与 给 定点 相 减 ， 得 到 的 误差 值 作为 数字 PID 校正 环节 的 
输入 。 主 处 理 器 可 以 在 任何 时 刻 读 取 LM629 的 运动 状态 ， 并 根据 实际 需要 调整 相应 的 命令 
值 以 实现 期 望 控制 。 当 LM629 控制 电动 机 运行 时 ， 除 了 加 速度 参数 外 ， 所 有 参数 值 均 可 以 
随机 改变 。 
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6. 4. 4 LM629 运动 控制 处 理 器 原理 介绍 


LM629 内 置 有 梯形 速度 发 生 器 ， 它 可 以 用 于 计算 所 需 的 梯形 速度 分 布 图 。 在 位 置 控制 
方式 时 ， 主 处 理 需 送 来 加 速度 、 最 高 转速 和 目标 位 置 数据 ，LM629 利用 这 些 数据 计算 运行 
轨迹 ， 如 图 6-22a 所 示 。 在 电动 机 运行 时 ， 上 述 参数 可 以 修改 ， 产 生 如 图 6-22b 所 示 的 运行 
轨迹 。 在 速度 控制 方式 时 ， 电 动机 用 规定 的 加 速度 加 速 到 指定 的 速度 ， 并 一 直 保 持 这 一 速 
度 ， 直 到 新 的 速度 指令 执行 。 

















转速 不 转速 m 人 4 
最 高 转速 
规定 的 匀 加 、 
减速 
时 间 7 时 间 7 
a) b) 


图 6-22 ”LM629 运行 轨迹 曲线 图 
a) 运行 中 位 置 、 速 度 不 变 “b) 运行 中 位 置 、 速 度 改变 


LM629 内 部 有 数字 PID 控制 器 ， 可 以 实现 闭环 系统 的 控制 。 数 字 PID 采用 增 量 式 PID 
控制 算法 ， 所 需 的 、k;、hs 控制 数据 均 由 主 处 理 器 提供 。 

经 实验 研究 得 知 ， 在 运动 控制 过 程 中 ，LM629 的 运动 加 速度 不 可 以 随机 更 改 ， 同 时 每 
一 次 发 送 加 速度 值 都 需要 完成 一 个 标准 的 梯形 曲线 图 ， 因 此 不 能 达到 图 6-22b 所 示 的 改进 图 
形 。 为 了 满足 控制 的 要 求 ， 在 LM629 输出 脉 宽 之 前 ， 将 加 速度 值 写 人 其 内 部 寄存 器 中 。 在 
运动 过 程 中 ,根据 需要 在 指定 时 间 将 速度 与 位 移 值 写 和 人 内 部 寄存 器 ， 即 可 实现 改进 梯形 图 的 
控制 。 

由 曲线 梯形 图 可 知 ， 在 加 速 与 减速 阶段 加 速度 恒定 ， 从 而 保证 了 起 始点 与 终止 点 速度 的 
平滑 过 渡 。 在 运动 过 程 中 ， 当 存在 速度 扰动 时 ， 由 PID 实现 补偿 控制 使 其 平均 速度 恒定 在 
期 望 速度 值 ， 同 时 实现 稳定 性 、 响 应 时 间 、 超 调 量 的 调节 。 


6. 4.5 LM629 内 部 的 PID 控制 算法 研究 


1. 常规 PID 控制 

在 工程 实际 中 ， 应 用 最 为 广泛 的 调节 器 控制 规律 为 比例 、 积 分 和 微分 控制 ,简称 为 PID 
控制 ， 又 称 为 PID 调节 。 

比例 控制 是 一 种 最 简单 的 控制 方式 ， 其 控制 器 的 输出 信和 号 与 输入 信号 成 比例 关系 ， 仅 当 
有 比例 控制 时 系统 输出 存在 稳 态 误差 ， 积 分 控制 中 ， 控 制 器 的 输出 与 输入 误差 信号 的 积分 成 
正比 关系 ,其 目的 是 使 系统 在 进入 稳 态 后 无 稳 态 误差 ， 微 分 控制 中 ， 控 制 器 的 输出 与 输入 误 
差 信 号 的 微分 成 正比 关系 ， 其 作用 是 避免 了 被 控 量 的 严重 超 调 。 

2. LM629 内 部 PID 控制 

LM629 内 部 采用 增 量 式 PID 控制 算法 ,根据 第 次 采样 时 刻 的 输入 偏差 值 ej 与 £-1 次 
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采样 时 刻 的 输入 偏差 值 el; ， 确 定 Aej ; 根据 实际 系统 的 稳定 性 、 响 应 时 间 与 超 调 量 的 要 求 ， 
将 记 、k、ka 写 人 LM629 中 。LM629 根据 Ae 与 局 、 琅 、 确定 n 次 采样 时 刻 的 控制 量 增 
量 Auj: 





Au, =k, Aes thier thaAY er (6-7) 
在 PID 控制 过 程 中 ， 引 入 积分 点 的 作用 是 消除 静态 误差 ， 提 高 控制 精度 。 但 却 增加 了 
系统 的 不 稳定 性 与 振荡 性 ， 尤 其 是 在 运动 控制 过 程 中 ， 当 六 自由 度 机 器 人 的 外 力矩 存在 着 较 
小 改变 时 ， 可 以 通过 LM629 内 部 的 速度 调整 实现 平滑 的 轨迹 运动 。 
因此 ， 在 控制 过 程 中 采用 积分 分 离 的 PID 控制 算法 ， 即 当 偏差 (被 调 量 与 给 定 值 ) 大 
于 某 一 预定 门限 值 时 ， 采 用 PD 控制 算法 ， 这样 可 避免 过 大 的 超 调 ， 又 使 系统 具有 和 较 快 的 响 
应 ; 当 偏 差 小 于 某 一 预定 门限 值 时 ， 采 用 PID 控制 算法 ， 以 实现 位 置 精度 的 控制 。 在 下 位 
机 软件 中 通过 实时 反馈 位 置 数据 与 预定 门限 值 的 比较 ， 从 而 决定 控制 系统 的 控制 方案 。 


6.5 控制 方式 


根据 不 同 的 分 类 方法 ， 机 器 人 控制 方式 可 以 有 不 同 的 分 类 。 从 总 体 上 ， 机 器 人 的 控制 方 
式 可 以 分 为 动作 控制 方式 和 示 教 控制 方式 。 按 照 被 控 对 象 来 分 ， 可 以 分 为 位 置 控制 、 速 度 控 
制 、 加 速度 控制 、 力 控制 、 力 和 矩 控制 、 力 和 位 置 混合 控制 等 。 

无 论 是 位 置 控制 或 速度 控制 ， 从 伺服 反馈 信号 的 形式 来 看 ， 又 可 以 分 为 基于 关节 空间 的 
伺服 控制 和 基于 作业 空间 〈 手 部 坐标 ) 的 伺服 控制 。 

机 器 人 的 控制 方式 主要 有 以 下 两 种 分 类 . 

1. 按 机 器 人 手 部 在 空间 的 运动 方式 分 

(1) 点 位 控制 方式 一 一 PTP 点 位 控制 又 称 为 PTP 控制 ， 其 特点 是 控制 机 器 人 手 部 在 
作业 空间 中 某 些 规定 的 离散 点 上 的 位 姿 。 

这 种 控制 方式 的 主要 技术 指标 是 定位 精度 和 和 运动 所 需 的 时 间 。 和 常常 被 应 用 在 上 下 料 、 搬 
运 、 点 焊 和 在 电路 板 上 插 接 元 器 件 等 定位 精度 要 求 不 高 且 只 要 求 机 器 人 在 目标 点 处 保持 手 部 
具有 准确 位 姿 的 作业 中 。 

(2) 连续 轨迹 控制 方式 一 一 CP 连续 轨迹 控制 又 称 为 CP 控制 ， 其 特点 是 连续 地 控制 
机 器 人 手 部 在 作业 空间 中 的 位 姿 ， 要 求 其 严格 地 按照 预定 的 路 径 和 速度 在 一 定 的 精度 范围 内 
运动 。 

这 种 控制 方式 的 主要 技术 指标 是 机 器 人 手 部 位 姿 的 轨迹 跟踪 精度 及 平稳 性 。 
通常 弧 焊 、 喷 涂 、 去 飞 边 和 检测 作业 的 机 器 人 都 采用 这 种 控制 方式 。 有 的 机 器 人 在 设计 
控制 系统 时 ， 上 述 两 种 控制 方式 都 具有 ， 如 对 进行 装配 作业 的 机 器 人 的 控制 等 。 

2. 按 机 器 人 控制 是 否 带 反 馈 分 

(1) 非 伺服 型 控制 方式 ” 非 伺服 型 控制 方式 是 指 未 采用 反馈 环节 的 开 环 控制 方式 。 

在 这 种 控制 方式 下 ， 机 器 人 作业 时 严格 按照 在 进行 作业 之 前 预先 编制 的 控制 程序 来 控制 
机 器 人 的 动作 顺序 ， 在 控制 过 程 中 没有 反馈 信号 ， 不 能 对 机 器 人 的 作业 进展 及 作业 的 质量 好 
坏 进 行 监测 ， 因 此 ， 这 种 控制 方式 只 适用 于 作业 相对 固定 、 作 业 程序 简单 、 运 动 精度 要 求 不 
高 的 场合 ， 它 具有 费用 省 ， 操 作 、 安 装 、 维 护 简单 的 优点 。 

(2) 伺服 型 控制 方式 ”伺服 型 控制 方式 是 指 采用 了 反馈 环节 的 闭环 控制 方式 。 
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这 种 控制 方式 的 特点 是 在 控制 过 程 中 采用 内 部 传感器 连续 测量 机 融 人 的 关节 人 位移、 速度 
和 加 速度 等 运动 参数 ， 并 反馈 到 驱动 单元 构成 闭环 伺服 控制 。 

如 果 是 适应 型 或 智能 型 机 融 人 的 伺服 控制 ， 则 增加 了 机 天 人 用 外 部 传 感 锅 对 外 界 环 境 的 
检测 ， 使 机 器 人 对 外 界 环 境 的 变化 具有 适应 能 力 ， 从 而 构成 总 体 闭 环 反馈 的 伺服 控制 方式 。 


6.6 单 关节 线性 模型 和 控制 











6. 6. 1 开 环 控制 系统 和 闭环 控制 系统 


开 环 控制 系统 是 最 基本 的 ， 它 是 在 手动 控制 基础 上 发 展 起 来 的 控制 系统 。 图 6-23 所 示 
的 电动 机 控制 系统 为 开 环 控制 系统 的 框图 。 

开 环 控制 调 速 系统 的 输入 量 w 由 手动 调 
季 ， 也 可 以 由 上 一 级 装置 调节 。 系 统 的 输出 “一 
量 是 电动 机 的 转角 速度 9。 如 图 6-23 所 示 ， 图 6-23” 开 环 控制 系统 的 框图 
系统 只 有 输入 量 的 向 前 给 定 控制 作用 ， 输 出 
量 (或 者 被 控 量 ) 没有 反馈 影响 输入 量 ， 即 输出 量 没 有 反馈 到 输入 端 参 与 控制 作用 。 且 输 
入 量 到 输出 量 控制 作用 是 单方 向 传递 ， 所 以 称 为 开 环 控制 系统 。 

将 系统 的 输出 量 反馈 到 输入 端 参 与 控制 ， 输 出 量 通过 检测 装置 与 输入 量 联系 在 一 起 形成 
一 个 闭合 回路 的 控制 系统 ， 称 为 闭环 控制 系统 (也 称 为 反馈 控制 系统 )。 如 图 6-24 所 示 ， 转 
动 角度 0 通过 位 置 检测 装置 和 反馈 电路 得 到 检测 信号 ， 经 放大 转换 后 作为 反馈 信号 ww 反馈 
到 输入 端 ， 与 给 定 信号 w 相 比 较 ， 产 生 偏差 信号 Aw =w -wm， 将 Av; 放大 后 作为 控制 信号 经 
功率 放大 后 对 电动 机 实现 控制 。 




































































图 6-24 闭环 控制 系统 的 框图 








6. 6. 2 ”模拟 控制 系统 和 数字 控制 系统 


模拟 控制 是 指控 制 系统 中 传递 的 信号 是 时 间 的 连续 信号 。 与 模拟 控制 相对 应 的 是 数字 控 
制 ， 在 这 种 系统 中 ， 除 某 些 环节 传递 的 仍 是 连续 信号 外 ， 另 一 些 环节 传递 的 信号 则 是 时 间 的 
断 续 信 号 ， 即 离散 脉冲 序列 或 数字 编码 。 这 类 系统 又 称 为 采样 系统 或 计算 机 控制 系统 。 

模拟 控制 是 最 早 发 展 起 来 的 控制 系统 ， 但 当 被 控 对 象 具 有 明显 滞后 特性 时 ， 这 种 控制 不 
适用 ， 因 为 它 容 易 引 起 系统 的 不 稳定 ， 又 难以 选择 时 间 常 数 很 大 的 校正 装置 来 解决 系统 的 不 
稳定 问题 。 采 用 数字 控制 ， 效 果 将 会 好 得 多 。 图 6-25 是 采样 控制 原理 图 ， 采样 开关 周期 性 
地 接 通 和 断 开 。5 接 通 时 系统 放大 系数 可 以 很 大 ， 进 行 调节 和 控制 ; $ 断 开 时 等 待 被 控 对 象 
自身 去 运行 ， 直 到 下 一 次 接 通 采样 开关 时 ， 才 检测 误差 ， 并 根据 它 来 继续 对 被 控 对 象 进行 控 
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制 。 这 样 从 控制 过 程 的 总 体 来 看 ， 系 统 的 平均 放大 系数 小 ， 容 易 保证 系统 的 稳定 ,但 从 开关 
接 通 的 调节 来 看 ， 系 统 的 放大 系数 很 大 ， 可 以 保证 稳 态 时 的 精度 。 









噪声 
误差 信号 本 
参考 信号 S 控制 器 被 控 量 
Se 


反馈 部 件 


图 6-25 采样 控制 原理 


采样 开关 将 连续 信号 离散 化 后 ,便于 用 计算 机 控制 ， 如 图 6-26 所 示 ， 图 中 A-D 为 模 数 
转换 器 ， 它 具有 采样 开关 可 将 模拟 信号 转换 成 离散 信号 ; D-A 为 数 模 转换 器 ， 将 数字 信号 转 
换 为 模拟 信号 ， 计 算 机 用 来 存储 信息 并 进行 信息 处 理 ， 使 系统 达到 预期 性 能 。 机 器 人 的 电动 


机 控制 系统 均 采用 计算 机 控制 方式 。 
m mu m(t) 

















c(n) 








图 6-26 计算 机 控制 原理 





6. 6. 3 伺服 系统 的 动态 参数 
在 对 机 器 人 的 伺服 系统 进行 讨论 之 前 ， 首 先 介 绍 伺服 系统 的 几 个 动态 参数 和 几 个 主要 


问题 。 

1. 伺服 系统 动态 参数 

(1) 超 调 量 伺服 系统 输入 单位 信号 ， 时 间 响 应 曲线 上 超出 稳 态 转速 的 最 大 转速 值 
( 瞬 态 超 调 ) 对 稳 态 转速 ( 终 值 ) 的 百分比 称 为 转速 上 升 时 的 超 调 量 ; 伺服 系统 运行 在 稳 态 
转速 ， 输 入 信号 阶 跃 至 零 ， 时 间 响 应 曲线 上 超出 零 转速 的 反 向 转速 的 最 大 转速 值 ( 瞬 态 超 
调 ) 对 稳 态 转速 的 百分比 称 为 转速 下 降 时 的 超 调 量 。 超 调 量 应 尽量 减 小 。 

(2) 转 矩 变化 的 时 间 响 应 ”如 图 6-27 所 示 ， 伺服 系统 正常 运行 时 ， 对 电动 机 突然 施加 
转 矩 负载 或 突然 卸 去 转 矩 负载 ， 电 动机 的 转速 随时 间 变 化 的 曲线 称 为 伺服 系统 对 转 矩 变化 的 
时 间 响 应 。 

(3) 阶 跃 输入 的 转速 响应 时 间 ”伺服 系统 输入 由 零 位 到 对 应 wy 的 阶 路 信号， 从 阶 跃 信 
号 开始 至 转速 第 一 次 达到 0. 9ww 的 时 间 称 为 阶 跃 输入 的 转速 响应 时 间 。 

(4) 建立 时 间 伺服 系统 输入 由 零 位 到 对 应 ww 的 阶 跃 信号 ， 从 输入 信号 开始 至 转速 达 
到 稳 态 转速 ( 终 值 ) ， 并 不 再 超过 稳 态 转速 ( 终 值 ) 的 +5% 的 范围 ， 所 经 历 的 时 间 称 为 系统 
建立 时 间 。 

(5) 频带 宽度 ”伺服 系统 输入 量 为 正弦 波 ， 随 着 正弦 波 信号 频率 逐渐 升 高 ， 对 应 输出 
量 相 位 澡 后 逐渐 加 大 ， 同 时 幅 值 逐渐 减 小 ， 相 位 滞后 增 大 到 90°* 时 或 幅 值 减 小 至 低频 段 幅 值 
1/vV2 时 的 频率 称 为 伺服 系统 的 频带 宽度 。 
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(6) 墙 转 电流 ” 堵 转 电流 也 称 为 瞬时 jg 










































































最 大 电流 ， 它 表示 伺服 电动 机 所 允许 承受 gyg | A， | 
的 最 大 冲击 负载 和 系统 的 最 大 加 速 力矩。 og 从 Nf 
2. 伺服 系统 的 几 个 主要 问题 09ov | 
(1) 稳 态 位 置 跟踪 误差 ” 当 系统 输入 规定 宽度 We 
言 号 瞬 态 响应 过 程 结 束 ， 进 入 稳定 运行 状 。 yw 
态 时 ， 伺 服 系统 执行 机 构 实 际 位 置 与 目标 时 间 -| 商 训 有 二 
值 之 间 的 误差 为 系统 的 位 置 跟踪 误差 。 | 建立 时 间 
在 闭环 全 负 反 馈 系统 中 ， 稳 态 误差 为 
1 9 
= rm 中 0 | 最 大 瞬 态 偏差 
式 中 Wo(s 馈 系统 的 开 环 传递 理想 值 明太 超 调 | 
3 初 值 
函数 ; axw 终 值 一 让 
系统 参考 输入 。 本 规定 宽度 稳 态 偏差 
由 式 (6-8) 可 知 ， 位 置 伺服 系统 的 位 -一 各 一 
置 跟踪 误差 既 与 系统 本 身 的 结构 有 关 , 也 wo 
与 系统 输 和 有关， 一 般 为 了 评价 伺服 系统 时 间 


的 跟踪 性 能 ， 必 须根 据 应 用 场合 确定 一 种 
标准 的 输入 形式 。 在 很 多 情况 下 ， 位 置 调 
节 带 多 采用 比例 型 ， 并 采用 斜坡 函数 输入 
言 号 确定 系统 的 稳定 跟踪 误差 ， 对 单位 斜坡 函数 输入 ， 有 


e= 一 (6-9) 


图 6-27 电动 机 伺服 系统 的 时 间 响 应 曲线 
a) 转速 初 值 为 零 b) 转速 初 值 不 为 零 





式 中 一 一 位 置 反 馈 增 益 。 
(2) 定位 精度 问题 ”系统 最 终 定位 点 与 指令 规定 值 之 间 的 静态 误差 为 系统 的 定位 精度 。 
这 是 评价 位 置 伺服 系统 位 置 控制 精度 的 重要 性 能 指标 。 对 于 位 置 伺服 系统 ， 至 少 应 能 对 指令 
输入 的 最 小 设 定单 位 ， 即 1 个 脉冲 做 出 响应 。 为 此 必须 选用 分 辩 率 足够 高 的 位 置 检测 器 件 。 
定位 精度 是 由 应 用 要 求 来 确定 的 ， 其 表达 式 为 





max 


Ae> 
“ED 


(6-10) 





式 中 ”Ae 一 一 位 置 伺服 系统 的 定位 精度 ，; 

i ; 

司 速 范围 。 

ee 位 置 增益 为 30V/rad， 要 求 定位 精度 为 0.01mm， 则 调 速 范围 
应 当 达 到 1 : 400 以 上 ， 实 际 上 为 使 系统 定位 精度 在 0.01mm 以 内 ， 和 常 选择 忆 为 1: 1000 以 
上 ， 若 要 求 系统 的 位 置 定 位 精度 达到 1um 以 内 ,应 使 D 大 于 1 : 10000。 

(3) 电动 机 的 利用 系数 ”现代 伺服 系统 均 采 用 电力 电子 器 件 以 调制 斩 波 形式 对 伺服 电 
动机 进行 驱动 ， 这 时 电 枢 电流 中 的 交流 分 量 使 它 的 有 效 值 大 于 平均 值 。 为 保证 电动 机 运行 温 
升 不 超过 规定 值 ， 需 要 减 小 电动 机 的 输出 力矩 。 电 动机 减 小 输出 力矩 的 程度 用 电动 机 的 利用 
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系数 (或 称 为 额定 率 ) 来 表示 
上 = 一 (6-11) 
式 中 一 一 伺服 电动 机 的 利用 系数 ; 


/一 电 枢 的 电流 平均 值 ， 
/一 电 枢 电 流 有 效 值 。 
6. 6.4 ”机 器 人 单 关 节 伺 服 控制 
1. 单 关节 的 位 置 和 速度 控制 
机 器 人 单 关节 的 位 置 控 制 是 利用 由 电动 机 组 成 的 伺服 系统 使 关节 的 实际 角 位 移 跟踪 预期 
的 角 位 移 ， 把 伺服 误差 作为 电动 机 输入 信号 ， 产 生 适当 的 电压 ， 即 
het) hl Ot) -0(t)] 

















U,(t)= (6-12) 
式 中 一 一 位 置 反 馈 增益 (V/rad); 
e(t)= 04(1) -0,(1) 一 一 系统 误差 ; 
n 传动 比 。 





实际 上 “单位 负 反 馈 ” 把 单 关节 机 器 人 系统 从 开 环 系统 转变 为 闭环 系统 ， 如 图 6-28 所 
示 。 关 节 人 角度 的 实际 值 可 用 光电 编码 融 或 电位 器 测 出 。 


1 + Ua(s) 1 7(s) 1 sem| | Or(s) 
n ka J + fop 去 n > 
SLatR, SJeff /eff S 


Os) 
































图 6-28 单 关 节 反 馈 控 制 


对 式 (6-12) 进行 拉 普 拉 斯 变换 ， 得 
k,[ Os)-O1(s)] hE(s) 


























U,(s)=— (6-13) 
将 式 (6-13) 代入 让- he 中 ， 得 出 由 误差 驱动 信号 [5(s)] 与 
ee HR 
实际 位 移 [【@,(s) ] 之 间 的 开 环 传递 函数 : 
Oj(s) kik, 
G(s)= 三 (6-14 ) 


E(s) s(sRaJ optRa J othak, ) 
由 此 可 以 得 出 系统 的 闭环 传递 函数 ， 它 表示 实际 角 位 移 @,(s) 与 预期 角 位 移 @14(s) 之 
间 的 关系 : 
Oi(s) G(s) kk, 
Os) 1+G(s) 52R,Jopts(R, fathaky) + 
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1 AR 
82+s(R, fthaky) AR Jogthak, AR 

上 式 表明 了 单 关节 机 器 人 的 比例 控制 器 是 一 个 二 阶 系统 。 当 系统 参数 均 为 正 时 ， 系 统 总 

是 稳定 的 。 为 了 改善 系统 的 动态 性 能 ， 减 少 静 态 误 差 ， 可 以 加 大 位 置 反 馈 增益 和 增加 阻 
尼 ， 再 引入 位 置 误差 的 导数 (角速度) 作为 反馈 信号 。 关 节 角 速度 常用 测速 电动 机 测 出 ， 
也 可 用 两 次 采样 周期 内 的 位 移 数据 来 近似 表示 。 加 上 位 置 反馈 和 速度 反馈 之 后 ， 关 节 电 动机 
上 所 加 的 电压 与 位 置 误差 和 速度 误差 成 正比 ， 即 





(6-15) 
















































































Re E(t) bl[ Ot) -Ot) eh 人 
式 中 太一 一 速度 反馈 增益 ; 
n 一 一 传动 比 。 

这 种 闭环 控制 系统 的 框图 如 图 6-29 所 示 。 

对 式 (6-16) 进行 拉 普 拉 斯 变换 ， 再 把 0。(s) 代入 式 an 本 
(6-16) 中 ， 可 得 误差 驱动 信号 E(s) 与 实际 位 移 之 间 的 传递 
函数 : 

9 (5s) k,(k,+sk,) kk,sthkk, 
Cp Re 人 
(6-17) 

由 此 可 得 出 表示 实际 角 位 移 @,(s) 与 预期 角 位 移 @4(s) ”9 0 
之 间 的 闭环 传递 函数 : 传递 函数 

Oi(s) Gpp(s) kak,sthak, ee 

Os) 1+Gpp(s) Rpts (Ro fpthakothak,) tkak, 图 699 电动 机 的 全 

(6-18) 变换 和 传递 函数 











显然 ， 当 和 =0 时 ， 上 式 变 为 式 (6-15)。 
式 (6-17) 所 代表 的 是 一 个 二 阶 系 统 ， 它 具有 一 个 有 限 和 零点 s=-k,k,， 位 于 s 平面 的 左 
半 平 面 。 系 统 可 能 有 大 的 超 调 量 和 较 长 的 稳定 时 间 ， 随 零点 的 位 置 而 定 。 图 6-30 所 示 为 操 
作 辟 的 控制 系统 受到 扰动 D(s) 的 影响 。 这 些 扰 动 是 由 重力 负载 和 连 杆 的 离心 引力 引起 的 。 
由 于 这 些 扰动 ， 电 动机 轴 输 出 力矩 的 一 部 分 被 用 于 克服 各 种 扰动 力 箱 。 由 下 式 


7 U,(s)-U,(s) 
§)= 一 一 一 一 一 一 
® R +sL, 





T(s)= s J oyOils) +sf oyO ,ls) 
T(s)= kl,(s) 
Vi(s)= sk, O,(s) 


b-_m 





得 出 
T(s)= (stsfy) Os)+D(s) (6-19) 
扰动 的 拉 普 拉 斯 变换 。 

















式 中 D(s) 
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扰动 输入 与 实际 关节 和 角 位 移 的 传递 函数 为 
0,(s) _nR, 

DCGJ Fo RCR fprhakythak,) +hak, 
根据 式 (6-17) 和 式 (6-19) ,运用 又 加 原理 ， 从 这 两 种 输入 可 以 得 到 关节 的 实际 位 移 : 
kk, tsk,) OF(s)-—nRD(s) 
SR Jots(R, fapthaky tk,k,) + 

需要 注意 的 是 上 述 闭环 系统 的 特性 ， 尤 其 是 在 阶 跃 输 入 和 斜坡 输入 产生 的 系统 稳 态 误差 
和 位 置 与 速度 反馈 增益 的 极限 。 
DO 


1 |+ Ua(s) 1 十 1 Om(s) Or(S) 
ka Sy 二 n 
n sLatR, SJef + fe S 


图 6-30 ”和 带 干 扰 的 反馈 控制 框图 


2. 位 置 和 速度 反馈 增益 的 确定 

二 阶 闭环 控制 系统 的 性 能 指标 有 : 上 升 时 间 、 稳 态 误差 、 调 整 时 间 。 这 些 都 和 位 置 反馈 
及 速度 反馈 增益 (%, 各,) 有 关 。 和 暂时 假定 系统 所 受 的 扰动 为 零 , 由 式 (6-17) 和 式 
(6-19) 可 知 ， 该 系统 基本 上 是 一 个 有 限 零 点 的 二 阶 系统 。 这 一 有 限 零 点 的 作用 常常 是 使 二 阶 
系统 提前 到 达 峰 值 ， 并 产生 较 大 的 超 调 量 〈 与 无 有 限 零点 的 二 阶 系统 相 比 ) 。 因 此 ， 需 要 确 
定 , 和 名, 的 值 ， 以 便 得 到 一 个 临界 阻尼 或 过 阻尼 系统 。 

对 于 一 个 二 阶 系统 的 特征 方程 具有 以 下 标准 形式 : 

s +2é0w,stw? =0 (6-22) 








(6-20) 





0,(s)= (6-21) 






































出 

















式 中 -系统 的 阻尼 比 ; 
w, 一 一 系统 的 无 阻尼 自然 频率 。 
由 闭环 系统 的 特征 方程 式 (6-19) 可 得 出 w, 和 & 分别 为 
kk 











w=— (6-23) 
Je 
R, fth hy tk,k, 
2é0, = ae (6-24) 
Jo 


由 此 可 知 ， 二 阶 系统 的 特性 取决 于 它 的 无 阻尼 自然 频率 w, 和 阻尼 比 &。 为 了 安全 起 见 ， 
希望 系统 具有 临界 阻尼 或 过 阻尼 ， 即 要 求 系统 的 阻尼 比 上 =1 (注意 : 系统 的 位 置 反馈 增益 
,>0 表示 负 反 馈 ) 。 将 由 式 (6-23) 所 求 得 的 w, 代入 式 (6-24) 可 得 

_R, fathak, +hk,k, 

















(6-25) 
2 kk, opRa 
因而 速度 反馈 增益 ,为 
2 kk, J R, -AR, ee kk, 
,> (6-26) 


ly k 


u 
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当 式 (6-25) 取 等 号 时 ， 系 统 为 临界 阻尼 系统 ， 取 不 等 号 时 ， 为 过 阻尼 系统 。 

在 确定 位 置 反 馈 增益 时， 必须 考虑 操作 臂 的 结构 刚性 和 共振 频率 ， 它 与 操作 臂 的 结 
构 、 尺 寸 、 质量 分 布 和 制造 装配 质量 有 关 。 在 前 面 建立 单 关节 控制 系统 模型 时 ， 忽 略 了 齿轮 
轴 、 轴 承 和 连 杆 等 零件 的 变形 ， 认 为 这 些 零件 和 传动 系统 都 具有 无 限 大 的 刚度 。 实 际 上 并 非 
如 此 。 各 关节 的 传动 系统 和 有 关 零 件 以 及 配合 衔接 部 分 的 刚度 都 是 有 限 的。 但 是 ， 如 果 在 建 
立 控制 系统 模型 时 ， 将 这 些 变形 和 刚性 的 影响 都 考虑 进去 ， 则 得 到 的 模型 是 很 高 阶 的 ， 使 得 
问题 复杂 化 。 因 此 ， 所 建立 的 二 阶 简化 模型 式 (6-22) 只 适用 于 机 械 传动 系统 刚度 很 高 、 共 
振 频 率 很 高 的 场合 。 令 关节 的 等 效 刚度 为 hj， 则 恢复 力矩 为 hy0,,(1) ， 它 与 电动 机 的 惯性 
力矩 相 平衡 ， 得 微分 方程 








Jrb m(t) +Keorg (ti)= 0 (6-27) 
系统 结构 的 共振 频率 为 
,= VE/ J (6-28) 





因为 在 建立 控制 系统 模型 时 ,没有 将 结构 的 共振 频率 w, 考虑 进去 ， 所 以 把 它 称 为 非 模 
型 化 频率 。 一 般 来 说 ， 关 节 的 等 效 刚度 hy 大 至 不 变 ， 但 是 等 效 惯性 力矩 J.y 随 末端 手 扑 中 的 
负载 和 操作 臂 的 姿态 而 变化 。 如 果 在 已 知 的 惯性 矩 有 之 下 测 出 的 结构 共振 频率 为 w。， 则 在 
其 他 惯性 矩 J 时 的 结构 共振 频率 为 
w, =wo VJo/ Joy (6-29) 
为 了 不 至 于 激 起 结构 与 系统 频率 耦合 共振 ，Paul 于 1981 年 建议 : 闭环 系统 无 阻尼 自然 
频率 w, 必须 限制 在 关节 结构 共振 频率 的 一 半 之 内 ， 即 








w, <0. 50, (6-30) 
根据 这 一 要 求 来 调整 反馈 增益 已， 由 于 已 >0， 从 式 (6-23) 和 式 (6-30) 可 以 求 出 
wr Joy 有 R。 
DR (6-31) 
由 式 (6-29) ， 上 式 可 写 为 
0<k oR (6-32) 
?~ 4k, 








, 求 出 后 ， 相 应 的 速度 反馈 增益 , 可 从 式 (6-26) 求 得 
天 ~ Rawo ~V JoJ op -hs fopkak, 
四 

















(6-33 ) 
3. 稳 态 误差 及 其 补偿 
e(t)=00(1) -01(t) (6-34) 
其 拉 普 拉 斯 变换 为 
E(s)= O14(s) -Os) (6-35) 
从 式 (6-20) ， 可 以 得 到 
ECs)= [s JyRats( R, fopthkk, ) | Od s) +nR,D(s) (6.36) 





sR,Jots(R, fapthak,) +hak, 
对 于 一 个 幅 值 为 4 的 阶 跃 输入 ， 即 04(1)= 4， 若 扰动 输入 未 知 ， 则 由 这 个 阶 跃 输入 产生 
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的 系统 稳 态 误差 可 从 “ 终 值 定理 ”导出 。 在 kk, 半 0 的 条 件 下 ， 可 得 稳 态 误差 es : 
Cssp = lime( t)= limsk(s) = 
[syRts(R, fstkaks) JA/stnR,D(s) 
.2 SR, J gts(R, fthokythk,) tkak, 
. nR,D(s) 
ee 
因此 。。 是 扰动 的 函数 。 有 些 干 扰 如 重力 负载 和 关节 速度 产生 的 离心 力 可 以 确定 ， 有 些 干 扰 
如 齿轮 的 路 合 摩擦 、 轴 承 摩 掠 和 系统 噪声 则 无 法 直接 确定 。 把 这 些 干 扰 力气 分 别 表示 为 
TD(ti=TeCt)+TCCE)+T。 (6-38) 
式 中 76(1) 一 一 连 杆 重力 产生 的 力矩 ; 
Te 四 一 一 连 杆 离心 力 产 生 的 力矩; 
7 一 一 除 重力 和 离心 力 之 外 的 扰动 力矩 。 
式 (6-38) 的 拉 普 拉 斯 变换 为 
D(s)= Ts) +T(s) +T,/s (6-39) 





(6-37) 























式 中 ,7, 为 恒 值 干扰 。 
6. 6.5 PID 控制 


按照 偏差 的 比例 (P，proportion)、 积 分 (I，integral) 、 微 分 (D，derivative) 进行 控制 
的 PID 控制 到 目前 仍 是 机 器 人 控制 的 一 种 基本 的 控制 算法 。 它 具有 原理 简单 、 易 于 实现 、 
鲁 棒 性 强 和 适用 面 广 等 优点 。 

1. 理想 微分 PID 控制 

理想 PID 控制 的 基本 形式 如 图 6-31 所 示 ， 表 达 式 为 

















1 de 
u=k, Ge edi+7， | (6-40) 
PID 控制 的 拉 普 拉 斯 变换 为 
Cs) _ 1 
2 5 人 rs] (6-41) 


其 中 , ,为 比例 增益 ; 7; 为 积分 时 间 ; 7 为 微分 时 间 ; z 为 操作 量 ; e 为 控制 输入 量 y 和 给 
定 值 之 间 的 偏差 。 





PID 控制 规律 


i 四 


控制 对 象 




















图 6-31 PID 控制 的 基本 形式 
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由 于 机 器 人 的 控制 系统 采用 的 是 计算 机 控制 ， 因 此 以 下 着 重 讨论 数字 实现 的 算法 。 为 了 
便于 计算 机 实现 ， 需 要 将 积分 式 和 微分 式 分 离 化 ， 即 


Jeqr = y Teli) (6-42) 
i=1 

de_e(n)-e(n-1) 

dt 了 9 





其 中 ,7 为 采样 时 间 ; n 采样 序列 ，e(n) 为 第 nn 次 采样 的 偏差 信号 。 
将 式 (6-42) 和 式 (6-43) 代入 式 (6-40) 可 得 


n 4 
wm) =h let) i ya et (6-44) 
T; Af 7 


由 于 理想 微分 控制 的 实际 控制 效果 并 不 理想 ， 其 微分 作用 只 持续 一 个 采样 周期 ， 而 机 器 
人 的 执行 机 构 的 调节 速度 受到 限制 ， 使 得 微分 作用 并 不 能 充分 发 挥 ， 因 此 常常 采用 实际 微分 
PID 控制 算法 。 

2. 实际 微分 PID 控制 

由 于 上 述 原 因 ， 以 一 惯性 环节 代替 式 (6-41) 中 的 微分 环节 ， 即 


1 Tys 
1+——+ 
Ts T) (6-45) 
1+——s 
d 


分 别 将 比例 、 积 分 和 微分 环节 用 差分 方程 离散 化 ， 得 到 实际 编程 用 的 增 量 形式 : 








U(s)_ 
ECs) 











Au,(n)=k,Le(n)-e(n-1)] (6-46) 
Me (6-47) 
i T 

T, 
Wa a hale) ebm) (6-48) 
Aus(n)= ua n) -ua n-1) (6-49) 
Au(n)= Au,(n) +Au,(n)+Auy(n) (6-50) 
u(n)=u(n-1)+Au(n) (6-51) 


实际 微分 PID 控制 的 优点 在 于 微分 作用 能 持续 多 个 周期 ， 使 一 般 工业 机 器 人 系统 能 够 
较 好 地 跟踪 微分 作用 的 输出 ， 并 且 其 所 含 的 一 阶 惯性 环节 具有 数字 滤波 作用 ， 使 得 控制 系统 
的 抗 干扰 能 力 较 强 ， 因 而 其 控制 品质 较 理想 微分 PID 控制 好 。 


6.7 本 竟 小 结 


本 章 首先 简单 介绍 了 机 器 人 控制 系统 的 一 般 形 式 和 特点 ， 重 点 讨论 了 机 器 人 控制 中 最 基 
本 的 位 置 控 制 问题 。 介 绍 了 机 器 人 的 传 感 絮 及 其 特点 要 求 。 分 析 了 单 关节 位 置 控制 的 传递 函 
数 ， 建 立 了 单 关 市 位 置 控制 器 ， 讨 论 了 控制 器 参数 确定 及 系统 的 误差 问题 。 在 机 器 人 运动 控 
制 系统 一 节 ， 以 LM629 控制 瑟 片 为 例 ， 对 机 器 人 的 运动 控制 做 了 进一步 阐述 。 对 机 絮 人 控 
制 系统 形式 做 了 简要 介绍 ， 针 对 机 器 人 的 实际 应 用 特点 和 性 能 要 求 ， 设 计 了 机 器 人 总 体 控制 
方案 ， 并 进行 了 实例 分 析 。 
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6-1 
0-2 
0-3 
0-4 
0-5 
6-6 
0-7 


习 题 


机 器 人 控制 系统 的 组 成 分 为 哪 四 大 部 分 ? 各 有 什么 作用 ? 

什么 是 机 器 人 的 二 级 控制 系统 ? 简 述 其 工作 原理 。 

机 絮 人 设计 和 常用 到 的 传 感 如 类 型 主要 包括 哪些 ? 

按照 测 距 原理 ， 机 器 人 测 距 传感器 分 几 种 类 型 ? 各 有 什么 特点 ? 

简 述 机 器 人 开放 式 控 制 系统 的 特点 ? 

机 器 人 的 点 位 控制 与 连续 轨迹 控制 各 有 什么 特点 ? 举例 说 明 其 应 用 场合 。 
机 器 人 伺服 系统 的 动态 参数 有 哪些 ? 


157 


EE 





7.1 机 器 人 轨迹 规划 的 分 析 


轨迹 规划 方法 一 般 是 在 机 絮 人 末端 初始 位 置 和 目标 位 置 之 间 用 多 项 式 函 数 来 “内 插 ” 
或 “ 允 近 ”给 定 的 路 径 ， 并 沿 时 间 轴 产生 一 系列 “控制 设 定点 ”"， 供 机 器 人 控制 之 用 。 路 径 
端点 既 可 以 用 关节 坐标 给 定 ， 也 可 以 用 笛 卡 儿 坐 标 给 定 ， 通 常 是 在 笛 卡 儿 坐 标 中 给 出 的 。 因 
为 ,在 稍 卡 儿 坐 标 中 比 在 关节 坐标 中 更 容易 正确 地 观察 末端 执行 器 的 形态 。 此 外 ， 关 节 坐 标 
并 不 适 于 作为 工作 坐标 系 ， 因 为 ， 大 多 数 机 顺 人 的 关节 坐标 并 不 正 交 ， 它 们 也 不 能 把 位 置 和 
姿态 分 开 。 如 果 需 要 某 些 位 置 的 关节 坐标 ， 则 可 调用 运动 学 逆 问 题 求 解 程序 ， 进 行 必 要 的 
转换 。 

在 给 定 的 两 端点 之 间 ， 常 有 多 条 可 能 的 轨迹 。 例 如 ， 可 以 要 求 机 器 人 沿 连 接 端 点 的 直线 
运动 〈 直 线 轨迹 ) ; 也 可 以 要 求 它 沿 一 条 光滑 的 多 项 式 轨迹 运动 ， 在 两 端点 处 满足 位 置 和 姿 
态 约束 (关节 变量 持 值 轨迹 ) 。 本 章 中 ,将 讨论 插值 的 方法 ,讨论 满足 路 径 约 束 的 轨迹 规划 











方法 。 
轨迹 规划 问题 的 通常 处 理 方法 是 将 轨迹 规划 絮 看 成 “黑箱 ”， 如 图 7-1 所 示 。 
轨迹 规划 器 接收 表示 路 径 约 束 的 输 路 径 约束 


入 变量 ， 输 出 起 点 和 终点 之 间 按 时 间 排 
列 的 机 器 人 末端 执行 器 中 间 形 态 (位 置 


和 姿态 、 速 度 、 加 速度 ) 序列 ， 它 们 可 a 
用 关节 坐标 或 备 卡 儿 坐 标 表示 。 规 划 机 路 从 证 多 迹 规划 六 0 


器 人 未 端 执行 器 轨迹 ， 有 两 种 常用 的 方 人 

法 。 第 一 种 方法 要 求 使 用 者 在 沿 轨迹 先 

定 的 位 置 ( 称 为 结 点 或 插值 点 ) 上 显 式 

地 给 定 广义 坐标 位 置 、 速 度 和 加 速度 的 A 

一 组 约束 (如 连续 性 的 光滑 程度 等 )。 I 

然后 ， 轨 迹 规划 器 从 插值 和 满足 插值 点 约束 的 函数 (通常 是 在 时 间 间 隔 [46，4y] 内 的 次 
或 小 于 nn 次 的 多 项 式 函 数 ) 中 选 定 参数 化 轨迹 。 第 二 种 方法 要 求 使 用 者 以 解析 函数 显 式 地 
给 定 机 器 人 必 有 经 的 路 径 ， 如 笛 卡 儿 和 坐标 中 的 直线 路 径 。 然 后 ,轨迹 规划 器 在 关节 和 坐标 或 任 卡 
儿 坐 标 中 确定 一 条 与 给 定 路 径 近 似 的 轨迹 。 在 第 一 种 方法 中 ,约束 的 给 定 和 机 器 人 轨迹 规划 
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是 在 关节 坐标 系 中 进行 的 。 由 于 对 机 器 人 手 部 没有 约束 ， 使 用 者 难以 跟踪 机 器 人 手 部 运行 的 
路 径 。 因 此 ， 机 器 人 手 部 可 能 在 没有 事先 警告 的 情况 下 与 障碍 物 相 磁 。 在 第 二 种 方法 中 ,路 
径 约束 是 在 笛 卡 儿 坐 标 中 给 定 的 ， 而 关节 驱动 器 是 在 关节 坐标 中 受 控制 的 。 因 此 ， 为 了 求 得 
一 条 逼近 给 定 路 径 的 轨迹 ， 必 须 用 函数 近似 把 笛 卡 儿 坐 标 中 的 路 径 约 束 变换 为 关节 坐标 中 的 
路 径 约束 ， 再 确定 满足 关节 坐标 路 径 约 束 的 参数 化 轨迹 。 

上 述 两 种 规划 机 器 人 轨迹 的 方法 应 能 产生 简单 的 轨迹 。 要 沿 机 器 人 预定 轨迹 高 效 、 光 
滑 、 准 确 地 生成 一 系列 控制 设 定点 ， 计 算 要 快速 〈 接 近 实 时 ) 。 可 是 ,产生 关节 变量 空间 位 
移 、 速 度 、 加 速度 矢量 q(t),， g(t),，4g (t)| 序列 ,并 未 考虑 机 天 人 的 动力 学 特性 ， 因 
此 ， 在 机 恬 人 伺服 控制 中 可 能 形成 较 大 的 跟踪 误差 。 

轨迹 规划 既 可 以 在 关节 变量 空间 中 进行 ， 也 可 以 在 笛 卡 儿 空 间 中 进行 。 对 于 关节 变量 空 
间 的 轨迹 规划 来 说 ， 要 规划 关节 变量 的 时 间 函 数 及 其 前 二 阶 时 间 导 数 ， 以 便 描 述 机 器 人 的 预 
期 运动 。 在 笛 卡 儿 空 间 规划 中 ， 要 规划 机 带 人 手 部 位 置 、 速 度 和 加 速度 的 时 间 函 数 ， 而 相应 
的 关节 位 置 、 速 度 和 加 速度 可 根据 手 部 信息 导出 。 在 关节 变量 空间 的 规划 有 三 个 优点 : 中 直 
接 用 运动 时 间 的 受 控 变量 规划 轨迹 ;，@ 轨 迹 规划 可 实时 地 进行 ，@) 关 节 轨 迹 易 于 规划 。 在 关 
节 变 量 空间 进行 规划 的 缺点 是 难以 确定 运动 中 各 杆 件 和 手 的 位 置 ， 但是， 为 了 避 开 轨迹 上 的 
障碍 ， 常 常 又 要 知道 末端 执行 器 当前 的 实际 位 置 。 

生成 关节 轨迹 设 定点 的 基本 算法 的 程序 流程 如 图 7-2 所 示 。 

其 中 ，A: 是 机 器 人 控制 的 采样 周期 。 

从 上 述 算法 可 以 看 出 ， 要 计算 的 是 在 每 个 控制 间隔 中 必须 更 新 的 轨迹 函数 (或 轨迹 规 
划 器 ) h(t)。 因 此 ， 对 规划 的 轨迹 要 提出 四 个 要 求 : 中 应 便于 用 迭代 方式 计算 轨迹 设 定点 ; 
@ 必 须 求 出 并 明确 给 定 中 间 位 置 ; 名 应 保证 关节 变量 及 其 前 二 阶 时 间 导 数 的 连续 性 ， 使 得 规 
划 的 关节 轨迹 是 光滑 的 ; 印 应 减少 额外 的 运动 。 

对 于 备 卡 儿 路 径 控制 ， 上 述 算法 可 修改 为 如 图 7-3 所 示 的 流程 。 




















1=tt A 


h(D)=1 时 刻 机 器 人 手 部 所 处 的 位 置 




















结束 
图 7-2 关节 变量 空间 轨迹 设 定点 算法 图 7-3 第 卡 儿 空 间 轨 迹 设 定点 算法 














对 于 笛 卡 儿 路 径 控 制 ， 除了 要 计算 每 一 控制 间隔 中 机 右 人 手 部 轨迹 函数 及 (1) 外 ， 还 需 
把 笛 卡 儿 位 置 变换 为 相应 的 关节 变量 0[L H(i) ]。 和 矩阵 函数 五 (1) 表示 机 器 人 手 部 在 :时刻 的 


159 

















| 工业 机 器 人 及 其 应 用 





预定 位 置 ， 可 用 4x4 的 齐 次 变换 矩阵 表示 。 

一 般 来 说 ， 实 现 笛 卡 儿 路 径 规 划 可 采用 下 述 两 个 步骤 ，(D 沿 笛 卡 儿 路 径 ， 按 照 某 种 规则 
以 笛 卡 儿 坐 标 生 成 或 选择 一 组 结 点 或 插值 点 ; @ 规 定 一 种 函数 ， 按 某 些 准则 连接 这 些 结 点 
(或 允 近 分 段 的 路 径 )。 所 选用 的 准则 常常 取决 于 采用 的 控制 算法 ， 以 保证 跟踪 给 定 的 路 径 。 
有 两 种 主要 的 控制 方法 : 也 面向 第 卡 儿 空间 的 方法 。 在 此 方法 中 ， 大 部 分 计算 和 优化 是 在 笛 
卡 儿 坐标 系 中 完成 的 ， 对 机 融 人 进行 控制 。 按 固定 的 取样 间隔 在 预定 路 径 上 选择 伺服 取样 
点 ， 在 控制 机 器 人 时 实时 地 把 它们 转换 为 与 之 相对 应 的 关节 变量 ， 所 得 到 的 轨迹 是 分 段 直 
线 。@) 面 向 关节 空间 的 方法 。 这 种 方法 用 关节 变量 空间 中 的 低 次 多 项 式 函 数 逼 近 直线 路 径 上 
的 两 相 邻 结 点 间 的 一 段 路 径 ， 而 控制 是 在 关节 这 一 级 上 进行 的 。 所 得 到 的 箭 卡 儿 路 径 是 不 分 
段 的 直线 。 可 用 限定 关节 路 径 偏 差 法 和 三 次 多 项 式 法 来 逼近 直线 路 径 。 

面向 第 卡 儿 空间 方法 的 优点 是 概念 直观 ， 而 且 沿 预定 直线 路 径 可 达到 相当 的 准确 性 。 可 
是 由 于 目前 还 没有 用 笛 卡 儿 坐 标 测量 机 器 人 手 部 位 置 的 传感器 ， 所 有 可 用 的 控制 算法 都 是 建 
立 在 关节 坐标 基础 上 的 。 因 此 ， 第 卡 儿 空间 路 径 规 划 就 需要 在 笛 卡 儿 和 坐标 与 关节 坐标 之 间 进 
行 实时 变换 ,计算 任务 量 大 ， 控 制 实时 性 较 差 。 此 外 ， 由 币 卡 儿 坐 标 向 关节 坐标 的 变换 是 病 
态 的 ， 因 为 它 不 是 一 对 一 的 映射 。 如 果 在 轨迹 规划 阶段 考虑 机 器 人 的 动力 学 特性 ， 就 要 以 箭 
卡 儿 坐标 给 定 路 径 约 束 ， 同 时 以 关节 坐标 给 定 物 理 约 束 〈 如 每 个 关节 电动 机 的 力 和 力 抢 、 
速度 和 加 速度 极限 ) 。 这 就 会 使 最 后 的 优化 问题 具有 在 两 个 不 同 坐标 系 中 的 混合 约束 。 

由 于 面向 第 卡 儿 空间 的 方法 有 上 述 种 种 缺点 ， 使 得 面向 关节 空间 的 方法 被 广泛 采用 ， 它 
把 笛 卡 儿 结 点 变换 为 相应 的 关节 坐标 ， 并 用 低 次 多 项 式 内 插 这 些 关 节 结 点 。 这 种 方法 的 优点 
是 计算 较 快 ， 而 且 易 于 处 理 机 器 人 的 动力 学 约束 。 但 是 ， 当 取样 点 落 在 拟 合 的 光滑 多 项 式 曲 
线 上 时 ， 面 向 关节 空间 的 方法 治 稍 卡 儿 路 径 的 准确 性 会 有 损失 。 


7.1.1 机 器 人 轨迹 的 概念 


机 需 人 轨迹 泛 指 机 融 人 在 运动 过 程 中 的 运动 轨迹 ， 即 运动 点 的 位 移 、 速 度 和 加 速度 。 

机 器 人 运动 轨迹 的 描述 一 般 是 对 其 手 部 位 姿 的 描述 ， 此 位 置 值 可 与 关节 变量 相互 转换 。 
控制 轨迹 也 就 是 按时 间 控 制 手 部 或 工具 中 心 走 过 的 空间 路 径 。 

机 器 人 在 作业 空间 要 完成 给 定 的 任务 ， 其 手 部 运动 必须 按 一 定 的 轨迹 进行 。 轨 迹 的 生成 
一 般 是 先 给 定 轨迹 上 的 若干 个 点 ， 将 其 经 运动 学 反 解 映射 到 关节 空间 ， 对 关节 空间 中 的 相应 
点 建立 运动 方程 ， 然 后 按 这 些 方程 对 关节 进行 插值 ， 从 而 实现 作业 空间 的 运动 要 求 ， 这 一 过 
程 通常 称 为 轨迹 规划 。 

在 机 器 人 完成 给 定 的 任务 之 前 ， 应 该 规定 它 的 操作 上 顺序、 行动 步 又 和 作业 进程 ， 即 任务 
规划 。 规 划 实 际 上 是 一 种 问题 的 求解 技术 ， 涉 及 的 范围 十 分 广泛 。 如 图 7-4 所 示 ， 任 务 规划 
器 根据 输入 的 任务 要 求 ， 规 划 执 行 任务 所 需 的 运动 ， 根 据 环 境 的 内 部 模型 和 外 部 传感器 在 线 
采集 的 数据 产生 控制 指令 。 而 轨迹 规划 是 根据 作业 任务 的 要 求 ， 计 算出 预期 的 运动 轨迹 。 

机 器 人 轨迹 规划 属于 机 絮 人 低层 规划 ， 基 本 上 不 涉及 人 工 智 能 的 问题 ， 本 章 仅 讨论 在 关 
节 空 间或 笛 卡 儿 空 间 中 机 咒 人 运动 轨迹 规划 和 轨迹 生成 方法 。 


7. 1.2 轨迹 规划 的 基本 问题 
机 老人 的 作业 可 以 描述 成 工具 坐标 系 |7| 相对 于 工件 坐标 系 {S| 的 一 系列 运动 。 例 
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机 器 人 
外 部 传感器 
机 器 人 | xO 
机 器 人 内 部 传感器 


图 7-4 机 器 人 任务 规划 


如 ， 图 7-5 所 示 将 销 插入 工件 孔 中 的 作业 可 以 借助 工具 坐标 系 的 一 系列 位 姿 P (i=1，2，…， 
n) 来 描述 。 这 种 描述 方法 不 仅 符合 机 带 人 用 户 的 思路 ， 而 且 有 利于 描述 和 生成 机 器 人 的 运 
动 轨迹 。 

用 工具 坐标 系 相对 于 工件 坐标 系 的 运动 来 描述 作业 路 径 是 一 种 通用 的 作业 描述 方法 。 它 
把 作业 路 径 描述 与 具体 的 机 器 人 、 手 爪 或 工具 分 离开 来 ， 形 成 了 模型 化 的 作业 描述 方法 ， 从 
而 使 这 种 描述 既 适 用 于 不 同 的 机 器 人 ， 也 适用 于 在 同一 机 器 人 上 装 夹 不 同 规格 的 工具 。 有 了 
这 种 描述 方法 就 可 以 把 图 7-6 所 示 的 机 器 人 从 初始 状态 运动 到 终止 状态 的 作业 看 作 是 工具 坐 
标 系 17o} 变化 到 终止 位 置 71) 的 坐标 变换 。 显 然 ， 这 种 变换 与 具体 机 器 人 无 关 。 一 般 
情况 下 ， 这 种 变换 包含 了 工具 坐标 系 位 置 和 姿态 的 变化 。 





4(D) 






































图 7-5 机 器 人 将 销 插 入 工件 孔 中 的 作业 描述 图 7-6 机 器 人 的 初始 状态 和 终止 状态 


在 轨迹 规划 中 ， 为 叙述 方便 ， 也 常用 点 来 表示 机 器 人 的 状态 ， 或 用 它 来 表示 工具 坐标 系 
的 位 姿 ， 如 起 始点 、 终 止 点 就 分 别 表示 工具 坐标 系 的 起 始 位 姿 及 终止 位 姿 。 

更 详细 地 描述 运动 时 不 仅 要 规定 机 器 人 的 起 始点 和 终止 点 ， 而 且 要 给 出 介 于 起 始点 和 终 
止 点 之 间 的 中 间 点 ， 也 称 为 路 径 点 。 这 时 ， 运 动 轨迹 除了 位 姿 约 束 外 ， 还 存在 着 各 路 径 点 之 
间 的 时 间 分 配 问 题 。 例 如 ， 在 规定 路 径 的 同时 ， 必 须 给 出 两 个 路 径 点 之 间 的 运动 时 间 。 

机 老人 的 运动 应 当 平稳 ， 不 平稳 的 运动 将 加 剧 机 械 部 件 的 磨损 ， 并 导致 机 器 人 的 振动 和 
冲击 。 为 此 ， 要 求 所 选择 的 运动 轨迹 描述 函数 必须 连续 ， 而 且 它 的 一 阶 导数 (速度 ) ， 有 时 
甚至 二 阶 导 数 (加 速度 ) 也 应 该 连续 。 

轨迹 规划 既 可 以 在 关节 空间 中 进行 ， 也 可 以 在 直角 坐标 空间 中 进行 。 在 关节 空间 中 进行 
轨迹 规划 是 指 将 所 有 关节 变量 表示 为 时 间 的 函数 ， 用 这 些 关 节 函 数 及 其 一 阶 、 二 阶 导数 捅 述 
机 器 人 预期 的 运动 ; 在 直角 坐标 空间 中 进行 轨迹 规划 是 指 将 手 不 位 姿 、 速 度 和 加 速度 表示 为 
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时 间 的 函数 ， 而 相应 的 关节 人 位置、 速度 和 加 速度 由 手 爪 位 姿 信息 导出 。 
7. 1.3 轨迹 规划 设计 的 主要 问题 


为 了 描述 一 个 完整 的 作业 ， 往 往 需要 将 上 述 运动 进行 组 合 。 通 常 这 种 规划 涉及 以 下 几 个 
方面 的 问题 ; 

1) 对 工作 对 象 及 作业 进行 描述 ， 用 示 教 方法 给 出 轨迹 上 的 若干 个 结 点 。 

2) 用 一 条 轨迹 通过 或 逼近 结 点 ， 此 轨迹 可 按 一 定 的 原则 优化 ， 如 加 速度 平滑 得 到 直角 
空间 的 位 移 时 间 函 数 x(t) 或 关 方 空间 的 位 移 时 间 函 数 gq(1) ; 在 结 点 之 间 如 何 进行 插 补 ， 即 
根据 轨迹 表达 式 在 每 一 个 采样 周期 实时 计算 轨迹 上 点 的 位 姿 和 各 关节 变量 值 。 

3) 以 上 生成 的 轨迹 是 机 器 人 位 置 控制 的 给 定 值 ， 可 以 据 此 并 根据 机 器 人 的 动态 参数 设 
计 一 定 的 控制 规律 。 

4) 规划 机 器 人 的 运动 轨迹 时 ， 尚 需 明 确 其 路 径 上 是 否 存在 障碍 约束 的 组 合 。 一 般 将 机 
器 人 的 规划 与 控制 方式 分 为 四 种 情况 ， 见 表 7-1。 

表 7-1 机 器 人 的 规划 与 控制 方式 



































障碍 约束 
有 无 
民 各 关 末 有 离线 无 碰撞 路 径 规 划 + 在 线路 径 跟 踪 离线 路 径 规 划 + 在 线路 径 跟 踪 
无 位 置 控制 + 在 线 障碍 探测 和 避 障 位 置 控制 











本 章 主 要 讨论 连续 路 径 的 无 障碍 轨迹 规划 方法 。 
7. 1.4 机 器 人 的 轨迹 规划 内 容 


轨迹 规划 至 少 包括 以 下 两 方面 的 内 容 : 一 是 对 机 器 人 的 任务 、 运 动 路 径 和 轨迹 进行 数学 
描述 ; 二 是 将 数学 描述 出 来 的 轨迹 转化 为 机 器 人 控制 顺 能 够 接收 的 控制 序列 。 对 于 机 器 人 ， 
特别 是 在 采用 示 教 一 再 现 工作 方式 时 ， 第 一 方面 的 内 容 更 多 情况 下 是 由 人 工 来 完成 的 ， 通 过 
主 从 示 教 、 示 教 盒 示 教 或 虚拟 示 教 对 轨迹 进行 示 教 或 描述 ， 而 由 轨迹 规划 品 自 动 完 成 将 轨迹 
转化 为 控制 天 可 以 接收 的 控制 序列 。 对 于 机 需 人 轨迹 规划 噩 ， 通 常 要求 能 够 实现 以 下 基本 插 
补 运算 : 在 关节 空间 实现 点 到 点 的 搬 补 ， 在 笛 卡 儿 空 间 实现 直线 、 圆 弧 的 插 补 。 有 了 这 些 基 
本 的 插 补 算法 就 可 以 拟 合 出 所 需要 的 复杂 空间 轨迹 ， 配 合 运动 学 正 、 反 解 算法 就 可 以 生成 控 
制 器 所 需要 的 控制 序列 。 


7.2 关节 运动 轨迹 的 插值 


为 了 控制 机 融 人 ， 在 规划 运动 轨迹 之 前 ， 需 要 给 定 机 器 人 在 初始 点 和 终止 点 的 手臂 形 
态 。 在 规划 机 器 人 关节 插值 运动 轨迹 时 ， 需 要 注意 下 述 几 点 : 

1) 抓 住 一 个 物体 时 ， 手 的 运动 方向 应 该 指向 离开 物体 支承 表面 的 方向 ， 否则 ， 手 可 能 
与 文 承 面相 碰 。 

2) 若 沿 支持 面 的 法 线 方向 从 初始 点 向 外 给 定 一 个 离开 位 置 〈 提 升 点 ) ， 并 要 求 手 〈 即 
手 部 坐标 系 的 原点 ) 经 过 此 位 置 ， 这 种 离开 运动 是 允许 的 。 如 果 还 给 定 由 初始 点 运动 到 离 
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开 位 置 的 时 间 ， 就 可 以 控制 提起 物体 运动 的 速度 。 

3) 对 于 手臂 运动 提升 点 的 要 求 同 样 也 适用 于 终止 位 置 运动 的 下 放 点 ( 即 必须 先 运 动 到 文 
承 表面 外 法 线 方向 上 的 某 点 ， 再 慢 慢 下 移 至 终止 点 ) 。 这 样 ， 可 获得 和 控制 正确 的 接近 方向 。 

4) 综合 起 来 ， 对 手臂 的 每 一 次 运动 ， 都 是 四 个 点 : 初始 点 、 提 升 点 、 下 放 点 和 终止 点 
( 见 图 7-7)。 

5) 位 置 约束 。 








关节 让 
QD 初始 点 : 给 定 速 度 和 加 速度 〈 一 般 为 零 ) 。 
Q 提升 点 : 中 间 点 运动 的 连续 。 
@) 下 放 点 : 同 提升 点 。 


( 终止 点 : 给 定 速度 和 加 速度 〈 一 般 为 零 ) 。 

6) 除 上 述 约束 外 ， 所 有 关节 轨迹 的 极 值 
不 得 超出 每 个 关节 变量 的 物理 和 几何 极限 。 

7) 时 间 的 考虑 。 

QD 轨迹 的 初始 阶段 和 终止 段 : 时 间 由 手 
接近 和 离开 支承 表面 的 速率 决定 ; 也 是 由 关节 
电动 机 特性 决定 的 某 个 常数 。 

G@ 轨迹 的 中 间 点 或 中 间 段 : 时间 由 各 关节 的 最 大 速度 和 加 速度 决定 ， 将 使 用 这 些 时 间 
中 的 一 个 最 长 的 时 间 〈 即 用 最 低速 关节 确定 的 最 长 时 间 来 归 一 化 ) 。 

规划 关节 插值 轨迹 的 约束 条 件 见 表 7-2。 在 这 些 约束 之 下 ， 所 要 研究 的 是 选择 一 种 n 次 
(或 小 于 n 次) 的 多 项 式 函 数 ， 使 得 在 各 结 点 〈 初 始点 、 提 升 点 、 下 放 点 和 终止 点 ) 上 满足 
对 位 置 、 速 度 和 加 速度 的 要 求 ， 并 使 关节 位 置 、 速 度 和 加 速度 在 整个 时 间 间 隔 [to, ty] 中 
保持 连续 。 一 种 方法 是 为 每 个 关 方 规定 一 个 七 次 多 项 式 函 数 ， 即 

gi(t)= art taets tast taatt tasatd tat tattao (7-1) 

其 中 ， 未 知 系数 w 可 由 已 知 的 位 置 和 连续 条 件 确定 。 可 是 ， 用 这 种 高 次 多 项 式 内 插 给 
定 的 结 点 也 许 不 能 令 人 满意 。 它 的 极 值 难 求 ， 而 且 容 易 产生 额外 的 运动 。 另 一 种 方法 是 将 整 
个 关节 空间 轨迹 分 割 成 几 段 ， 在 每 段 轨 迹 中 用 不 同 的 低 次 多 项 式 来 插值 ， 有 几 种 分 割 轨迹 的 
方法 ， 每 种 方法 的 特性 各 不 相同 。 常 用 的 有 4-3-4 关节 轨迹 (4 次 多 项 式 -3 次 多 项 式 -4 次 
多 项 式 ) 、3-5-3 关节 轨迹 和 五 段 三 次 关节 轨迹 。 

表 7-2 规划 关节 插值 轨迹 的 约束 条 件 




















图 7-7 关节 轨迹 的 位 置 条 件 




















1) 位 置 (给 定 ) 

初始 位 置 。 ”2) 速度 (给 定 ,通常 为 零 ) 
3) 加 速度 ( 给 定 ,通常 为 堆 ) 

站 提升 位 置 (给 定 ) 

2 ) 提升 点 位 置 (与 前 一 段 轨 迹 连 绪 ) 

3) 速 度 ( 与 前 一 段 轨迹 连续 ) 

4) 加 速度 ( 与 前 一 段 轨迹 连续 ) 

5) 下 放 点 位 置 (给 定 ) 

6) 下 放 点 位 置 (与 前 一 段 轨 迹 连 绪 ) 

7) 速 度 ( 与 前 一 段 轨迹 连续 ) 

8) 加 速度 ( 与 前 一 段 轨迹 连续 ) 

站 位 置 (给 定 ) 

终止 位 置 。 | 2) 速度 (给 定 ,通常 为 堆 ) 

3) 加 速度 ( 给 定 ,通常 为 堆 ) 











中 间 位 置 
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7.2. 1 播 补 方式 及 分 类 


轨迹 规划 技术 有 两 种 典型 的 作业 : 中 点 位 (Point to Point，PTP) 控制 ; 包 连 续 路 径 
(Continuous Path，CP) 控制 。 

给 出 各 个 路 径 结 点 后 ， 轨 迹 规 划 的 任务 包含 解 变 换 方程 、 进 行 运动 学 反 解 和 插值 计算 。 
在 关节 空间 进行 规划 时 ， 需 进行 的 大 量 工作 是 对 关节 变量 的 插值 计算 。 

点 位 控制 (PTP 控制 ) 通常 没有 约束 ， 多 以 关节 坐标 运动 表示 。 点 位 控制 只 要 满足 起 
终点 位 姿 ， 在 轨迹 中 间 只 有 关节 的 几何 限制 、 最 大 速度 和 加 速度 约束 ; 为 了 保证 运动 的 连续 
性 ， 要 求 速度 连续 、 各 轴 协 调 。 连 续 路 径 控 制 (CP 控制 ) 有 路 径 约 束 ， 因 此 要 对 路 径 进行 
设计 。 路 径 控制 和 插 补 方式 分 类 见 表 7-3。 

表 7-3 路径 控制 和 插 补 方式 分 类 

路 径 控 制 不 插 补 关节 择 补 (平滑 ) 空间 捕 补 
1) 各 轴 独 立 快速 达到 
点 位 控制 PTP 2) 各 关节 最 大 加 速度 
限制 











1) 各 轴 协 调和 运动 定时 搬 补 
2) 各 关节 最 大 加 速度 限制 














1) 在 空间 插 补 点 间 进 行 关 节 定 时 插 补 1) 直线 、 圆 弧 . 曲线 等 距 
2) 用 关节 的 低 阶 多 项 式 拟 合 空间 直线 | 搬 补 

使 各 轴 协 调运 动 2) 起 停 线 速度 、 线 加 速度 给 
3) 各 关节 最 大 加 速度 限制 定 ,各 关节 速度 .加 速度 限制 









































7.2.2 机 器 人 轨迹 控制 过 程 


机 器 人 的 基本 操作 方式 是 示 教 一 再 现 ， 操 作 过 程 中 ， 不 可 能 把 空间 轨迹 的 所 有 点 都 示 教 
一 遍 使 机 器 人 记 住 ， 对 于 有 规律 的 轨迹 ， 仅 示 教 几 个 特征 点 ， 计 算 机 就 能 利用 搬 补 算法 获得 
中 间 点 的 坐标 ， 如 直线 需要 示 教 两 点 ， 圆 弧 需 要 示 教 三 点 ， 通 过 机 带 人 逆向 运动 学 算法 由 这 
些 点 的 坐标 求 出 机 噩 人 各 关节 的 位 置 和 角度 (gl ，…，g,)， 然 后 由 后 面 的 角 位 置 闭环 控制 
系统 实现 要 求 的 轨迹 上 的 一 点 。 继 续 插 补 并 重复 上 述 过 程 ， 从 而 实现 要 求 的 轨迹 。 轨 迹 持 补 
的 基本 方法 是 直线 择 补 和 圆 弧 持 补 ， 这 是 机 如 人 系统 中 的 基本 插 补 算法 。 非 直线 和 圆 弧 轨迹 
可 以 用 直线 或 圆 弧 允 近 ， 以 实现 这 些 轨迹 。 机 器 人 轨迹 控制 过 程 如 图 7-8 所 示 。 


轨迹 上 示 教 点 
插 补 算法 


的 位 置 及 姿态 
7.2.3 关节 空间 插 补 算法 
机 融 人 实现 一 个 空间 轨迹 的 过 程 即 是 实现 轨迹 离散 的 过 程 ， 如 果 这 些 离散 点 间隔 很 大 ， 
则 机 器 人 运动 轨迹 与 要 求 轨迹 可 能 有 较 大 误差 。 只 有 这 些 插 补 得 到 的 离散 点 彼此 距离 很 近 ， 
才 有 可 能 使 机 絮 人 轨迹 以 足够 的 精确 度 允 近 要 求 的 轨迹 。 模 拟 CP 控制 实际 上 是 多 次 执行 插 








要 求 的 位 


个 角度 位 置 | 这 、 姿态 






图 7-8 机 器 人 轨迹 控制 过 程 
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补 点 的 PTP 控制 ， 插 补 点 越 密 集 ， 越 能 禹 近 要 求 的 轨迹 曲线 。 

Re 不 失真 和 运动 连续 平滑 呢 ? 可 采用 定时 搬 补 和 定 距 插 补 
方法 来 解决 。 

1. 定时 插 补 

由 轨迹 控制 过 程 可 知 ， 每 持 补 出 一 轨迹 点 的 坐标 值 ， 就 要 转换 成 相应 的 关节 角度 值 并 加 
到 位 置 伺服 系统 以 实现 这 个 位 置 ， 这 个 过 程 每 隔 一 个 时 间 间 隔 i, 完成 一 次 。 为 保证 运动 的 
平稳 ， 显 然 i, 不 能 太 长 。 

当然 越 小 越 好 ,但 它 的 下 限 值 受 到 计算 量 限 制 ， 即 对 于 机 融 人 的 控制 ,计算机 要 在 
时 间 里 完成 一 次 插 补 运算 和 一 次 逆向 运动 学 计算 。 对 于 目前 的 大 多 数 机 器 人 控制 器 ， 完 成 这 
样 一 次 计算 约 需 几 毫秒 。 这 样 产 生 了 上 到 的 下 限 值 。 当 然 ， 应 当选 择 二 接近 或 等 于 它 的 下 限 
值 ， 这 样 可 保证 较 高 的 轨迹 精度 和 平滑 的 运动 过 程 。 

设 机 器 人 需要 的 运动 轨迹 为 直线 ， 运 动 速度 为 ” (mm/s) ， 时 间 间 隔 为 太 (ms) ， 则 每 
个 到 间隔 内 机 器 人 应 走 过 的 距离 为 



































PiPin =t, (7-2) 

可 见 两 个 插 补 点 之 间 的 距离 正比 于 要 求 的 运动 速度 ， 两 点 之 间 的 轨迹 不 受 控 制 ， 只 有 插 
补 点 之 间 的 距离 足够 小 ， 才 能 满足 一 定 的 轨迹 精度 要 求 。 

采用 定时 中 断 方式 每 隔 t, 中 断 一 次 进行 一 次 插 补 ， 计 算 一 次 逆向 运动 学 ， 输 出 一 次 给 
定 值 。 由 于 仅 为 几 毫 秒 ， 机 器 人 沿 着 要 求 轨 迹 的 速度 一 般 不 会 人 
精度 不 如 数控 机 床 、 加 工 中 心 高 ， 故 大 多 数 机 器 人 采用 定时 插 补 方式 。 

当 要 求 以 更 高 的 精度 实现 运动 轨迹 时 ， 可 采用 定 距 插 补 。 

2. 定 距 插 补 

v 是 要 求 的 运动 速度 ， 它 是 可 以 变化 的 ， 如 果 要 求 两 插 补 点 的 距离 P,P;,1 恒 为 一 个 足够 
小 的 值 ， 以 保证 轨迹 精度 ，t, 就 要 变化 。 也 就 是 在 此 方式 下 ， 插 补 点 距离 不 变 , 但 i, 要 随 
着 不 同 工 作 速度 wv 的 变化 而 变化 。 

这 两 种 插 补 方式 的 基本 算法 相同 ， 只 是 定时 插 补 固定 1,， 易于 实现 ， 定 距 插 补 保证 轨迹 
插 补 精度 ,但 i. 要 随 之 变化 ， 实 现 起 来 比 前 者 困难 。 

3. 三 次 多 项 式 插值 

现在 考虑 机 械 手 末端 在 一 定时 间 内 从 初始 位 置 和 方位 移动 到 目标 位 置 和 方位 的 普遍 性 问 
题 。 利 用 道 运 动 学 计算 ， 可 以 首先 求 出 一 组 起 始 和 终止 的 关节 位 置 。 因 此 ， 运 动 轨迹 的 描述 
可 用 起 始点 关节 角度 与 终止 点 关节 角度 的 一 个 
平滑 函数 g(t) 来 表示 ,g(t) 在 0=0 时 刻 的 值 
是 起 始 关节 角度 go， 在 终端 时 刻 jj 的 值 是 终止 
关节 角度 gr。 显 然 满 足 这 个 条 件 的 光滑 函数 可 
以 有 许多 条 ， 如 图 7-9 所 示 。 现 在 的 问题 是 求 出 
一 组 通过 起 始点 和 终点 的 光滑 函数 。 

机 器 人 控制 的 目的 就 是 按 预 定性 能 要 求 保 mw 























| 





qr 









































持 机 械 手 的 动态 响应 ， 但 是 由 于 机 器 人 机 械 手 | EEE 
的 惯性 力 、 耦 合 反应 力 和 重力 负载 等 都 随 运动 ” RS 
空间 的 变化 而 变化 ， 因 此 要 对 它 进行 高 精度 、 ee 
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高 速 、 高 动态 品质 的 控制 是 相当 复杂 而 困难 的 。 目 前 机 器 人 上 采用 的 控制 方法 是 把 机 械 手 上 
的 每 一 个 关节 都 当 作 一 个 单独 的 伺服 机 构 ， 即 把 一 个 非 线性 的 、 关 节 间 耦合 的 变 负 载 系统 ， 
简化 为 线性 的 非 耦合 单独 系统 ， 并 且 对 每 一 个 单独 的 系统 采用 PID 闭环 控制 ， 这 种 方法 对 
于 像 机 器 人 这 样 速度 要 求 不 是 太 高 、 负 和 荷 也 不 大 的 系统 来 说 基本 满足 实际 要 求 了 。 
为 了 实现 单个 关节 的 平稳 运动 ， 轨 迹 函 数 g(1) 至 少 需要 满足 四 个 约束 条 件 。 其 中 两 个 
约束 条 件 是 起 始点 和 终止 点 对 应 的 关节 和 角度: 
ee 
d(tr)=91/ 
为 了 满足 关节 运动 速度 的 连续 性 要 求 ， 另 外 还 有 两 个 约束 条 件 ， 即 在 起 始点 和 终止 点 的 
关节 速度 要 求 。 在 当前 情况 下 ， 规 定 : 





(7-3) 





| on (7-4) 
q (ti)=0 
上 述 四 个 边界 约束 条 件 式 〈7-3) 和 式 (7-4) 唯一 地 确定 了 一 个 三 次 多 项 式 : 
q(t)= aotaittast tast’ (7-5) 
运动 轨迹 上 的 关节 速度 和 加 速度 则 为 
| (1)=alt+2ast+3a3t 
， (7-6) 
q (1)= 2a,+6a3t 


将 式 (7-5) 和 式 (7-6) 代入 相应 的 约束 条 件 ， 得 到 有 关系 数 a6。、al 、as 和 os 的 四 个 
线性 方程 : 
qo=0 
0/= 0tatytaty tast (7.7) 
0=al 
0=awli+2a2tr+3a3 
求解 上 述 方程 组 可 得 
Zoo 一 40 


a1=0 


3 
a = (gq/-q0) (7-8) 
处 





2 
3 一 a 91-90) 
ty 


这 组 解 只 适用 于 关节 起 始 速度 和 终止 速度 为 零 的 运动 情况 。 对 于 其 他 情况 ， 后 面 另行 
讨论 。 

一 般 情况 下 ， 要 求 规划 过 路 径 点 的 轨迹 。 如 果 机 械 手 在 路 径 点 停留 ， 则 可 直接 使 用 前 面 
三 次 多 项 式 插值 的 方法 ;如 有 果 只 是 经 过 路 径 点 ， 并 不 停留 ， 则 需要 推广 上 述 方法 。 然 而 在 实 
际 应 用 中 ， 常 常 需要 考虑 中 间 点 的 信息 ， 即 使 对 于 点 位 控制 的 机 带 人 ， 机 械 手 末端 的 运动 也 
并 不 是 简单 地 从 一 个 点 运动 到 另 一 个 点 ， 而 对 中 间 点 的 运动 轨迹 无 任何 要 求 。 例 如 ， 机 械 手 
将 物体 从 一 处 搬 到 另 一 处 时 ， 通 常 将 物体 垂直 进行 由 上 放下 的 操作 。 因 此 操作 人 员 除 了 给 定 
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起 始点 和 终止 点 外 ， 还 将 给 出 几 个 中 间 的 经 过 点 。 在 利用 关节 空间 的 规划 时 ， 也 是 首先 在 工 
具 空 间 规划 出 光滑 的 曲线 ， 以 使 它 能 通过 这 些 路 径 点 ， 一 个 最 简单 的 方法 是 将 轨迹 分 成 几 
段 ， 而 每 一 段 则 直接 采用 上 面 介绍 的 三 次 多 项 式 方法 连接 相 邻 的 两 个 点 。 但 是 这 个 方法 规划 
出 的 结果 使 得 中 间 点 产生 停顿 ， 而 常常 不 希望 在 中 间 点 出 现 停顿 。 

实际 上 ， 可 以 把 所 有 路 径 点 也 看 作 是 “起 始点 ”或 “终止 点 ”， 求解 逆 运 动 ， 得 到 相应 
的 关节 矢量 值 。 然 后 确定 所 要 求 的 三 次 多 项 式 插 值 函 数 ， 把 路 径 点 平滑 地 连接 起 来 。 但 是 ， 
在 这 些 “ 起 始点 ”或 “终止 点 ”不 再 是 零 ， 也 即 不 使 中 间 点 产生 停顿 ， 可 以 在 中 间 点 上 指 
定期 望 的 速度 ， 而 仍 采 用 前 面 介绍 的 三 次 多 项 式 的 规划 方法 。 一 般 情况 下 可 将 式 (7-4) 的 
约束 条 件 改 为 








440)=14 
2 (7-9) 
9(tr)=97 
确定 三 次 多 项 式 的 四 个 方程 为 
qo=0 
qj=aotaitytastf taaty 
, (7-10) 
40 一 01 
dr=al+2a21r+3aa3 要 
求解 以 上 方程 组 ， 可 求 得 三 次 多 项 式 的 系数 为 


20 一 40 





a1=40 
3 2 1 .; 

02= 7 (090) 9 (7-11) 
te 人 


2 Le 
a3=- 3 (990) + (qo0+qy) 
ty ty 





实际 上 ， 由 式 (7-9) 确定 的 三 次 多 项 式 描述 了 起 始点 和 终止 点 具有 任 辣 给 定位 置 和 速 
度 的 运动 轨迹 ， 是 式 (7-4) 的 推广 。 当 规划 下 一 段 时 ， 可 将 该 段 的 终点 速度 作为 下 一 段 的 
起 始 速度 。 剩 下 的 问题 就 是 如 何 确定 路 径 点 上 的 关节 速度 。 通 常 可 由 以 下 三 种 方法 规定 这 个 
速度 : 

1) 在 直角 坐标 空间 中 指定 机 械 手 末端 的 线 速度 和 速度 ， 这 对 用 户 来 说 要 相对 容易 些 ， 
然后 再 将 这 些 速度 转换 到 相应 的 关节 空间 。 但 是 如 果 中 间 点 对 于 机 械 手 来 说 是 一 个 奇异 点 ， 
那么 用 户 便 不 能 在 这 一 点 任意 指定 速度 。 这 对 用 户 来 说 也 很 不 方便 。 因 此 指定 中 间 点 速度 的 
工作 最 好 由 系统 来 完成 ， 以 尽量 减轻 用 户 的 负担 。 下 面 的 两 种 方法 可 做 到 这 一 点 。 

2) 运用 知觉 知识 ， 由 系统 本 身 来 合理 地 给 定 中 间 点 的 速度 。 这 个 选择 是 基于 如 下 的 想 
法 : 将 中 间 点 首先 用 直线 连接 起 来 ， 如 果 这 些 线 在 中 间 点 处 的 斜率 改变 正 负 号 ， 则 选 该 点 处 
的 速度 为 零 ; 如 果 这 些 线 的 斜率 不 改变 符号 ， 则 选 两 边 斜 率 的 平均 值 作 为 该 点 的 速度 。 然 
后 ， 按 照 这样 知 觉 的 想法 来 给 定 中 间 点 的 速度 是 合理 的 。 利 用 这 个 方法 ， 用 户 可 以 不 需要 输 
入 中 间 点 的 速度 ， 而 只 需要 输入 一 系列 的 路 径 点 以 及 每 两 点 之 间 的 运动 持续 时 间 。 

3) 通过 要 求 在 中 间 点 处 的 加 速度 连续 而 自动 选择 中 间 点 的 速度 。 为 了 实现 这 一 点 ， 实 
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际 上 ， 相当 于 求解 一 个 新 的 样 条 函数 解 。 
点 后 ， 轨 迹 规划 的 任务 包含 解 变 换 方程 ， 进 行 运动 学 反 解 和 插值 计算 。 





给 出 各 个 路 径 结 

















在 关节 空间 进行 规划 时 ， 需 进行 的 大 量 工 作 是 对 关节 变量 的 插值 计算 。 
关 方 空间 的 插值 采用 过 路 径 点 的 三 次 多 项 式 持 值 法 。 其 原理 是 利用 已 知 某 一 关节 运动 初 
始 时 刻 的 位 置 9(1;) 、 速 度 0 (1;) 和 期 望 y 时 刻 的 位 置 (zw ) 、 速 度 0 (六 ) ， 确 定 一 个 三 次 多 


项 式 0(t)= cotcittest? test 的 四 个 系数 CO、 Cl、 





cs、c3o。 然后 利用 得 到 的 多 项 式 ， 基 于 时 间 的 


变化 ,产生 一 系列 地 包含 位 置 、 速 度 信息 的 点 序列 (6(411), 6(1)),， (09(4),， 6 (4)),…， 
(6()，6 (4,))。 关 节 空 间 插 补 软件 设计 流程 如 图 7-10 所 示 。 





某 路 径 段 时 间 A7 






已 走 完 路 径 段 时 
间 A7 之 和 <7 





终点 已 到 ， 











图 





插值 计算 (7) 





电动 机 停 转 或 
转 入 下 一 个 
工作 循环 






吾 


该 路 径 段 终 点 已 到 ， 
转 入 下 一 路 径 段 











7-10 ”关节 空间 插 补 软件 设计 流程 


流程 图 中 了 为 走 完整 段 轨迹 的 时 间 ，A7 为 各 个 路 径 段 的 运行 时 间 ，: 为 实际 运行 时 间 ， 


l=} 





其 步 长 A 可 根据 机 器 人 作业 的 具体 情况 进行 调整 ，Ak=A7-: 为 最 后 一 步 的 修正 量 ， 其 初 值 
为 0，bp 为 第 7 关节 在 各 个 路 径 段 的 起 始 关 节 角 ，09,(t) 为 上 时 刻 的 关节 变量 插值 。 

4. 用 抛物 线 过 渡 的 线性 插值 

在 关节 空间 轨迹 规划 中 ， 对 于 给 定 起 始点 和 终止 点 的 情况 选择 线性 函数 插值 较为 简单 ， 
如 图 7-11 所 示 。 然 而 ,单纯 线性 插值 会 导致 起 始点 和 终止 点 的 关节 运动 速度 不 连续 ， 且 加 
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速度 无 穷 大 ， 显 然 ， 在 两 端点 会 造成 刚性 冲击 。 

为 此 应 对 线性 函数 插值 方案 进行 修正 ， 在 线性 插值 两 端点 的 邻 域内 设置 一 段 抛物 线形 组 
冲 区 段 。 由 于 抛物 线 函 数 对 于 时 间 的 二 阶 导 数 为 常数 ， 即 相应 区 段 内 的 加 速度 恒定 ， 这 样 保 
证 起 始点 和 终止 点 的 速度 平滑 过 渡 ， 从 而 使 整个 轨迹 上 的 位 置 和 速度 连续 。 带 有 抛物 线 过 渡 
的 线性 轨迹 如 图 7-12 所 示 。 









































oh 

oh 0 

Or 0, 

Oa 

Go 6 
0 i 
图 7-11 两 点 间 的 线性 插值 图 7-12 带 有 抛物 线 过 渡 的 线性 轨迹 








设 两 端的 抛物 线 具 有 相同 的 持续 时 间 1。 ， 具 有 大 小 相同 而 符号 相反 的 恒 加 速度 6 。 对 
于 这 种 路 径 规划 存在 有 多 个 解 ， 其 轨迹 不 唯一 ， 如 图 7-13 所 示 。 假 设 每 条 路 径 都 对 称 于 时 
间 中 点 刀 和 位 置 中 点 6, 。 

要 保证 路 径 轨 迹 的 连续 、 光 滑 ， 即 要 求 抛 物 线 轨 























Oh 
迹 的 终点 速度 必须 等 于 线性 段 的 速度 ， 故 有 下 列 关系 
0,-0, 0 
PR (7-12) 
i -to 
其 中 ,90, 为 对 应 于 抛物 线 持续 时 间 1 的 关节 和 角 
度 。9, 的 值 为 
万 
0 =0+ (7-13)  ， 
设 关节 从 起 始点 到 终止 点 的 总 运动 时 间 为 4， 则 “ 
ty=2t,， 并 注意 到 0 a th 人 六 
1 图 7-13 ”轨迹 世 性 与 对 称 ' 
0, = (07+0,) (7-14) 。 图 7-13 轨迹 的 多 解 性 与 对 称 性 


则 由 式 (7-12) ~ 式 (7-14) 得 
Or-0Ott+(0,-00)=0 (7-15) 
一 般 情况 下 ，0,、9/,、 纪 是 已 知 条 件 ， 这 样 ， 根 据 式 (7-12) 可 以 选择 相应 的 6 和 ， 
得 到 相应 的 轨迹 。 通 常 的 做 法 是 先 选 定 加 速度 96 的 值 ， 然 后 按照 式 (7-15) 求 出 相应 的 : 
EL -46 (0,-00) 
20 











(7-16) 


a 
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由 式 (7-16) 可 知 ， 为 保证 i。 有 解 ， 加 速度 值 6 必须 选 得 足够 大 ， 即 


re 


(7-17) 


当 式 (7-17) 中 的 等 号 成 立时 ， 轨 迹 线性 段 的 长 度 缩减 为 零 ， 整 个 轨迹 由 两 个 过 渡 域 组 
成 ， 这 两 个 过 渡 域 在 衔接 处 的 斜率 (关节 速度 ) 相等 ; 加 速度 0 的 取 值 越 大 ， 过 渡 域 的 长 
度 就 变 得 越 短 ， 若 加 速度 趋 于 无 穷 大 ， 轨 迹 又 复归 到 简单 的 线性 插值 情况 。 

用 抛物 线 过 渡 的 线性 函数 插值 进行 轨迹 规划 的 物理 概念 非常 清楚 ， 即 如 果 机 右 人 每 一 关 
节 电 动机 采用 等 加 速 、 等 速 和 等 减速 运动 规律 ， 则 关节 的 人 位置、 速度、 加 速度 随时 间 变 化 的 
曲线 如 图 7-14 所 示 。 








人 人 人 
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06 13 18 24 30™ 06 12 18 24 30™ 
位 移 时 间 //s 速度 时 间 1/s 加 速度 时 间 i/s 


图 7-14 ” 带 有 抛物 线 过 渡 的 线性 插值 


若 某 个 关节 的 运动 要 经 过 一 个 路 径 点 ， 则 可 采 
用 带 有 抛物 线 过 渡 域 的 线性 路 径 方案 。 如 图 7-15 
所 示 ， 关 节 的 运动 要 经 过 一 组 路 径 点 ， 用 关节 角 加 
速度 1 ”所 ”所 | 表示 其 中 三 个 相 邻 的 路 径 点 ， 
以 线性 函数 将 每 两 个 相 邻 路 径 点 相连 ， 而 所 有 路 径 ”上 和 -所 
点 附近 都 采用 抛物 线 过 渡 。 应 该 注意 到 : 各 路 径 段 ， 
采用 抛物 线 过 渡 域 线性 函数 所 进行 的 规划 ， 机 器 全 一 2 
的 运动 关节 并 不 能 真正 达到 那些 路 径 点 。 即 使 选取 图 7-15 多 段 带 有 抛物 线 过 渡 域 的 线性 轨迹 
的 加 速度 充分 大 ， 实 际 路 径 也 只 是 十 分 接近 理想 路 
径 点 。 









0 















7.3 笛 卡 儿 空 间 规 划 方 法 


7.3.1 第 卡 儿 空间 的 直线 插 补 算法 


直线 插 补 和 圆 弧 插 补 是 机 器 人 系统 中 的 基本 插 补 算法 。 对 于 非 直线 和 圆 弧 轨迹 ， 可 以 采 
用 直线 或 圆 绝 通 近 ， 以 实现 这 些 轨 迹 。 

空间 直线 插 补 是 给 定 直 线 始 末 两 点 的 位 姿 ， 求 轨迹 中 间 点 〈 插 补 点 ) 的 位 姿 。 直 线 插 
补 时 ， 机 天 人 的 姿态 变化 按照 给 定 的 步 长 从 初始 姿态 均匀 向 末端 点 姿态 变化 。 当 然 在 有 些 情 
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况 下 要 求 变化 姿态 ， 这 就 需要 姿态 插 补 ， 可 仿照 下 面 介绍 的 位 置 插 补 原理 处 理 ， 也 可 参照 圆 
弧 的 姿态 插 补 方式 解决 ， 如 图 7-16 所 示 。 已 知 直线 始末 两 点 的 坐标 值 Pj(xi, yi1,，z1) 和 已 
(x >，Yy，，2z2 ) ， 其 中 P| 、P, 是 相对 于 基 坐 标 系 的 位 置 。 这 些 已 知 的 位 置 和 姿态 通常 是 通过 
示 教 方式 得 到 的 。 设 " 为 要 求 的 沿 直线 运动 的 速度 ; 1 为 插 补 时 间 间 隔 。 这 些 坐 标点 从 对 话 
框 的 点 位 姿 ， 可 以 通过 以 下 步骤 进行 直线 轨迹 的 定 步 长 插 补 : 

1) 给 定 步 长 参数 AL。 在 程序 中 ， 步 长 参数 











可 以 由 操作 者 输入 或 使 用 默认 值 ， 它 在 某 种 意义 Daly) 
上 反映 了 要 求 的 直线 精度 。 
2) 为 减少 实时 计算 ， 示 教 完成 后 ， 可 求 出 直 人 
线 的 长 度 : 
- 








L= (x2—%1) +(y2 -71) 十 (22 一 51 ) 
t, 间隔 内 行程 为 d=, 


3) 计算 插 补 总 步 数 N。N 等 于 直线 长 度 工 除 
以 步 长 AL 的 整数 部 分 . 图 7-16 空间 直线 插 补 
N=L/AL 
4) 计算 插 补 增 量 
Ax=(x,—x1)/AN 
Ay=(y2-71)/N 
Az=(z,-z1)/AN 
5) 计算 第 i 个 插 补 点 的 坐标 值 .: 
xX;=X1 tiXAx 
yi=y1+tiXAy 
z;=2Z1 +iXAz 
其 中 , i=1, 2, …,N-1。 


7.3.2 第 卡 儿 空 间 的 平面 圆 缴 插 补 算法 
此 处 的 平面 圆 弧 是 指 圆 弧 平面 与 基础 坐标 系 的 三 大 平面 之 一 重合 ， 以 x0y 平面 圆 允 








为 例 。 
已 知 不 在 同一 直线 上 的 三 点 坐标 Pi (xi， Y1， 21) ， PCxo2， 》2， 22 ) ， Ps(x, 》3， 23 ) 及 
三 点 对 应 的 末端 的 姿态 ， 如 图 7-17 所 示 。 其 插 补 算法 如 下 : 





1) 由 Pi、P,、Ps 确定 圆心 坐标 〈xo，yo )。 由 Ps (X33) 

等 式 : 
(x1—X0) +(y1 -yo0) =(x2-x0)2+(72 一 Yo) 
=(x3-x0) +(y3-y0)” 


得 出 圆 弧 圆 心 点 (x0， yo ) oO 
2) 求 圆 弧 半径 R 和 始末 角 位 置 9, ，0,。 OG) 
图 7-17 平面 圆 弧 插 补 











R= (x1-x0) +(y1 -yo0)” 
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0 = arctan 
03 = arctan 
NX3 XO 
3) 总 的 圆心 角 po=pi+p，。 
2R?-[ (x x1) +( yy1)" ] 
Pp1 =arccos op 
2R°-[ (x3-%2) +(y3-y2)"] 
Pp» =arccos 2 
4) 计算 在 A7 时 间 内 角 位 移 增 量 Ap。 
Ap=(AT.v)/R 
5) 计算 所 需 插 补 步 数 N。 
N=p/Ap-1 ”(NN 为 整数 ) 
6) 计算 插 补 点 位 置 。 圆 弧 方 程 为 
x=xot+ReosOl 
oe 
第 i 个 插 补 点 坐标 为 


. =xot+Reos( 0. +iXAgp) 


. , (i=1,2,.…,N) 
yi=yot+Rsin( 01+iXAgp) 


7. 3.3 笛 卡 儿 空 间 的 空间 圆 弧 插 补 算法 


这 里 的 空间 圆 弧 是 指 三 维 空间 中 任意 一 个 平面 里 的 圆 踊 。 可 以 分 三 步 来 实现 空间 圆 弧 的 
插 补 计算 : 第 一 步 建立 新 坐标 系 将 空间 圆 弧 转化 为 平面 圆 弧 ; 第 二 步 利 用 平面 圆 弧 插 补 算 
法 ,， 求 出 平面 圆 弧 插 补 点 的 坐标 值 ; 第 三 步 将 这 些 点 的 坐标 值 转换 为 基础 坐标 系 下 的 坐 
标 值 。 

如 图 7-18 所 示 ,， 已 知 不 共 线 的 空间 三 点 坐标 P (xl ，71， 
z1)，Ps(x2，Y2，z2)，Pa(x3，Y3，23)， 由 它们 可 以 确定 一 个 
圆 弧 。 

1) 首先 建立 一 个 新 的 坐标 系 O"x'y'z' 将 空间 圆 弧 转化 为 平 
面 圆 弧 。 

以 贺 弧 起 点 PP, 为 原点 0'，PiP; 为 *' 轴 ，PiP;xPiP, 又 积 
的 指向 为 z' 轴 方向 ，y' 轴 由 右手 法 则 确定 。 这 样 圆 弧 就 落 在 
0O'x'y' 平 面 内 。 将 P)，P,，P; 在 坐标 系 0'x'y'z' 内 表示 。 需 要 
用 到 的 齐 次 变换 9 7 在 第 3 步 中 给 出 。 图 7-18 空间 圆 弧 插 补 

2) 利用 平面 圆 弧 插 补 算法 求解 插 补 点 的 坐标 值 。 

3) 将 第 2 步 计 算得 到 的 0'x'y'z' 下 的 坐标 值 转换 为 基础 坐标 系 Oxyz 下 的 坐标 值 。 

要 将 0'x'y'z' 下 的 坐标 值 转换 为 基础 坐标 系 Oxyz 下 的 坐标 值 ， 首 先 就 要 求解 0'x'y'z' 到 
Oxyz 的 齐 次 变换 。 它 由 各 轴 的 方向 余弦 以 及 原点 坐标 平移 确定 。 
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%' 轴 正 向 与 PiPs 矢量 方向 一 致 
PiP,= [x3—x1 3 1 23 21 | 
z' 轴 正 向 与 Pi 户 ;xPiP, 矢量 方向 一 致 : 
PiP,= | x2 —x1 ,2 )1,22 21 | 
进而 可 求 得 PiP,xPi 户 ， 
y' 轴 由 右手 法 则 确定 。 
将 矢量 单位 化 后 可 得 到 x’、y'、z' 的 单位 矢量 . 


{ns ,Ty ,ns | >» | oov，oz| ,| a ,Qay ,Go| 


那么 ， 从 Oxyz 坐标 系 到 0'x'y'z' 坐 标 系 的 齐 次 变换 可 表示 为 


站 n, of 0 yi 
Oe 


nN, 0; Qs; Z1 


从 Ox'iy'z 坐标 系 到 Owyz 坐标 系 的 齐 次 变换 是 0,T 


7 7 nN 一 (7 X1 二 77 ”7yY1+7 z1) 


由 有 P. 马 . 咏 确 定 新 的 坐标 系 O'xy'z 





Ox O7y O02 一 (ov X1 二 O7y “ Yi tO z1) 


在 坐标 系 O'x'y'z 下 表示 PB、 忆 
0 0 0 1 


空间 圆 孤 插 补 流程 如 图 7-19 所 示 。 
7.3.4 第 卡 儿 空 间 插 补 算法 的 补充 说 明 


应 当 指 出 前 面 所 表述 的 笛 卡 儿 空 间 插 补 算法 实 将 插 补 点 华 标 变换 到 坐标 系 Ooc 下 
际 上 是 维持 姿态 不 变 对 位 置 进 行 插 补 。 它 在 实际 情 | 


况 中 也 用 得 非常 广泛 ， 如 捅 销 装配 、 直 线 弧 焊 、 在 


笛 卡 儿 空间 相对 于 世界 坐标 系 的 平移 、 相 对 于 工具 


0O'T— 
0 T= 


按 平面 圆 弧 插 补 方法 计算 插 补 点 坐标 

















坐标 系 的 平移 等 。 但 有 时 也 会 用 到 在 择 补 过 程 中 要 
求 姿态 也 发 生变 化 的 情况 ， 这 时 ， 至 少 有 三 种 插 补 
方案 可 供 选 择 第 一 ， 可 以 先 保 持 位 置 不 变 ， 对 姿 图 7-19 空间 圆 弧 插 补 流程 





态 进 行 搬 补 ， 调 整 好 姿态 后 ， 再 对 位 置 进行 插 补 ; 
第 二 ， 先 对 位 置 进行 插 补 ， 到 达 末 端 位 置 时 ， 再 对 姿态 进行 择 补 ; 第 三 ， 位 置 和 姿态 同时 进 
行 择 补 。 具 体 使 用 哪 一 种 ， 由 工作 任务 要 求 来 确定 。 


7.4 四 元 数 与 直线 轨迹 规划 


二 维 平面 上 的 旋转 可 以 用 复数 来 表达 ， 三 维 空间 中 的 旋转 则 可 以 用 四 元 数 来 表达 。 用 四 
元 数 表达 三 维 的 旋转 与 使 用 矩阵 相 比 具有 两 个 优点 : 第 一 ， 几 何 意义 明确 ; 第 二 ， 计 算 简 
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单 。 此 外 ， 四 元 数 代数 还 涵盖 了 矢量 代数 ， 实 数 、 复 数 和 矢量 都 可 以 看 作 是 四 元 数 的 特例 ， 
可 以 在 一 个 统一 的 体系 中 进行 运算 。Paul 提出 利用 齐 次 变换 和 矩阵 表示 目标 位 置 ， 生 成 直线 
运动 轨迹 。 这 种 描述 方法 易于 理解 和 使 用 。 可 是 矩阵 需要 较 大 的 存储 空间 ， 需 要 较 多 的 运算 
量 。 而 且 ， 和 矩阵 法 表示 转动 是 高 度 匈 余 的 ， 这 可 能 引起 数值 上 的 不 一 致 。Taylor 等 指出 ， 利 
用 四 元 数 表示 转动 将 会 使 运动 更 均匀 和 有 效 。 他 对 结 点 间 的 直线 运动 规划 问题 提出 了 两 种 方 
法 。 第 一 种 方法 称 为 直角 坐标 路 径 控制 法 ， 是 Paul 方法 的 改进 ,但 使 用 四 元 数 表示 转动 。 
这 种 方法 简便 ， 并 且 给 出 更 均匀 的 旋转 运动 。 但 是 ， 它 需要 大 量 的 运算 ， 且 易 使 操作 臂 产生 
退化 形 位 。 第 二 种 方法 称 为 有 界 偏差 关节 路 径 法 ， 此 法 在 动作 规划 阶段 ， 选 取 足 够 多 的 结 
点 ， 用 关节 变量 的 线性 插值 控制 操作 臂 ， 使 之 与 直线 路 径 的 偏差 不 超过 预定 值 。 这 种 方法 大 
大 减少 了 在 每 个 采样 间隔 中 需 做 的 计算 量 。 

1. 四 元 数 的 基本 概念 

四 元 数 起 源 于 寻找 复数 的 三 维 对 应 物 。 复 数 可 以 表达 一 个 二 维 矢 量 ， 当 处 理 不 共 面 的 多 
个 矢量 时 ， 需 要 用 新 的 数 来 表达 一 个 三 维 矢 量 。1843 年 Hamilton 发 明了 四 元 数 ， 这 是 一 种 形 
如 A=aotalitaytask 的 数 ，i,，j, 大 满足 刀 = 产 = 妥 =-1，7=- 帮 =5， 大 =- 厅 =i1， 大 =- 应 = 一 。 这 
一 新 数 包 含 4 个 分 量 ， 并 且 不 满足 乘法 的 交换 律 。 哈 密 顿 给 出 了 四 元 数 的 加 法 、 乘 法 规则 以 
及 四 元 数 的 逆 和 模 ， 指 出 四 元 数 能 通过 旋转 、 伸 长 或 缩短 将 一 个 给 定 的 矢量 变 成 另 一 个 矢 
量 。 同 年 ，Grassmann 定义 了 形 如 a=ajel+ases+a3e3 的 超 复 数 ， 并 研究 了 它 的 n 维 情形 。 他 
定义 了 超 复 数 的 内 积 和 外 积 ， 并 给 出 几何 意义 ， 但 在 乘积 中 二 阶 单元 eej (一 阶 单元 的 乘 
积 ) 未 被 简化 成 一 阶 单元 。 结 合 后 来 的 著述 可 以 看 出 他 的 研究 思路 还 是 线性 代数 ， 线 性 代数 
中 的 许多 基本 概念 就 是 他 提出 的 。 在 1855 年 的 一 篇 文章 中 他 定义 了 16 种 不 同类 型 的 乘积 ， 给 
出 了 这 些 乘 积 的 几何 意义 ， 并 应 用 于 力学 、 磁 学 、 唱 体 学 。Maxwell 将 四 元 数 的 数量 部 分 和 矢 
量 部 分 分 开 ， 作 为 实体 处 理 ， 做 了 大 量 的 矢量 分 析 。 三 维 矢量 分 析 的 建立 及 同 四 元 数 的 正式 分 
有 裂 是 18 世纪 80 年 代 由 Gibbs 和 Heaviside 独立 完成 的 。 矢 量 代数 被 推广 到 矢量 函数 和 矢量 微 积 
分 。 由 此 开始 了 四 元 数 和 矢量 分 析 的 争论 ， 最 终 矢量 分 析 占 了 上 风 。 从 纯粹 代数 的 观点 看 ， 四 
元 数 是 令 人 兴奋 的 ， 因 为 它 提供 了 一 个 除了 乘法 的 交换 律 外 ， 具 有 实数 和 复数 性 质 的 例子 。 
四 元 数 已 经 成 功 地 用 于 空间 机 构 的 分 析 。 在 此 应 用 四 元 数 表示 机 器 人 手 部 的 姿态 ， 进 行 
直线 轨迹 规划 。 
四 元 数 是 实数 和 复数 以 及 三 维 空间 矢量 的 扩充 。 复 数 仅 有 两 个 单元 1 和 i， 四 元 数 有 四 
个 单元 1，i, j,k。 后 三 个 单元 具有 循环 置换 的 性 质 .: 

这 = = =-l 


y=h, =i hi= 






















































































=-hk, k=-i,ik=-] 
这 样 的 三 个 单元 i, j, 可 看 成 直角 坐标 系 的 三 个 基本 矢量 。 于 是 ， 一般 四 元 数 0 的 形式 为 
Q=[stv] =staitbjtck=(s,a,b,c) 
因此 它 表 示 为 一 个 标量 部 分 * 和 一 个 矢量 部 分 v。 其 中 s，a, 5,c 都 是 常数 。 
四 元 数 具 有 以 下 基本 性 质 : 
0 的 标量 部 分 : 
0 的 矢量 部 分 : v=ai+tbj+tck 
0 的 共 恩 ，s-(ai+tbj+tck) 
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0 的 范 数 : s?+ta?+b?+c? 
A SS—(aitbjtck) 
0 的 倒数 : RE 
单位 四 元 数 : stai+tbj+ck， 其 中 人 +a?+b?+tc*=1。 显 然 ， 实数 (s，0,，0,，0)， 复数 (s， 
a,，0,，0) ,三维 空间 矢量 (0，a, 5, c) 都 是 四 元 数 (s，a, 5b, c) 的 特殊 情况 。 实 数 只 
有 一 个 单元 1， 复数 含有 两 个 单元 1 和 i， 三 维 空间 矢量 含有 三 个 单元 i, j,k。 
四 元 数 的 代数 运算 规划 如 下 。 
加 ( 减 ) 法 运算 规则 : 两 四 元 数 的 和 ( 差 ) 等 于 两 者 对 应 元 素 的 和 ( 差 ) 。 
乘法 规则 : 两 四 元 数 相 乘 ， 即 
Q1Q2= (51+ta1itbtck) (stasitb2jtc,k) 
= (8182—0 * w+sl WD +s Vi +o Xw ) (7-18) 
注意 : 四 元 数 的 加 法 满足 交换 律 和 结合 律 。 但 是 ,乘法 只 满足 结合 律 ， 并 不 满足 交换 
律 。 因 此 ， 进 行 乘法 运算 时 ， 等 式 右边 按 初等 代数 配 项 ， 但 要 保持 各 单元 的 次 序 ， 一 般 不 能 
交换 。 另 外 ， 两 个 三 维 矢量 表示 成 四 元 数 再 相 乘 ， 得 到 的 不 是 一 个 矢量 ， 而 是 一 个 四 元 数 。 
例如 ，0Q1=[0+tvw1]=(0,a1,01;,c1)，0Q;=[0+v 5]=(0,as,03,c3)， 由 式 (7-18) 得 
Q102= -0 * tv Xx (7-19) 
利用 四 元 数 代数 ， 可 以 简单 而 有 效 地 处 理 空间 有 限 转动 问题 。 把 绕 n 轴 转 9 角 的 旋转 
Rot (n,，0) 用 一 个 四 元 数 表示 为 


Rot(n,0)= 区 上 tin . | (7-20) 


例 7-1 绕 轴 旋转 90° 可 用 四 元 数 乘积 来 表示 : 
(cos45°+jsin45°) (cos45°+ksin45°) 


| | | 
=| + 一 HK 一 七 
之 ”也 2 


本 站 
三 Re 。 3 = cos60° +sin60° 2 
/3 



































2 
Rote , 2o] 
V3 
其 合成 转动 是 绕 与 i,， j,k 轴 等 倾角 的 轴 转 动 120"。 这 与 前 面 所 讲 的 用 旋转 矩阵 所 得 到 的 结 
果 完 全 相同 ,但 是 用 四 元 数 方 法 更 为 简单 。 可 以 用 两 种 方法 表示 同一 转动 ， 这 两 种 方法 可 以 
相互 转化 。 表 7-4 列 出 了 使 用 四 元 数 和 和 抢 阵 表示 常用 的 旋转 运算 的 计算 量 。 
表 7-4 ”使 用 四 元 数 和 矩阵 的 计算 量 























运 算 四 元 数 表示 和 矩阵 表示 
RIR, 9 次 加 法 ,16 次 乘法 15 次 加 法 ,24 次 乘法 
Ry 12 次 加 法 ,22 次 乘法 6 次 加 法 ,9 次 乘法 
R—Rot(n,0) 4 次 乘法 8 次 加 法 ,10 次 乘法 
1 次 求 平方 根 2 次 求 平方 根 
1 次 调用 反正 切 函 数 1 次 调用 反正 切 函 数 
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2. 直角 坐标 路 径 控制 法 
将 操作 臂 工 具 坐 标 系 治 直 线路 径 在 时 间 了 内 由 结 点 Po 运动 到 Pi 的 规划 方法 如 下 : 手 
部 坐标 系 的 每 一 结 点 用 齐 次 变换 矩阵 表示 为 


六 
P,= 
和 | 


运动 包括 两 部 分 : 工具 坐标 系 的 原点 从 Pu 移动 到 P ， 坐 标 系 的 姿态 由 Ro 转 到 RI。 令 
A(t) 为 在 时 刻 上 还 要 进行 剩余 运动 所 需 的 时 间 与 总 时 间 了 之 比 。 那 么 对 于 匀速 运动 ， 有 
ls, (7-21) 
7 
其 中 , 7 是 该 段 轨 迹 所 需 时 间 ; i 是 由 这 段 轨迹 起 点 算 起 的 时 间 ， 工具 坐标 系 在 时 间 ;的 位 
置 和 姿态 分 别 用 下 面 两 式 表 达 





p(t)=p1-A(t) (pi1-po) (7-22) 
R(i)= RRot[n,-0A(i)] (7-23) 

其 中 ，Rot(n，0) 是 将 工具 姿态 由 Ro 转 为 Ri 而 绕 轴 n 转 9 角 的 旋转 ， 即 
Rot(n,0)= RoR (7-24) 


其 中 ，Rot (有 ，69) 代表 以 四 元 数 表 示 的 合成 转动 Ri R。 值 得 注意 的 是 ， 如 果 坐 标 系 已 
国定 不 变 ， 则 式 (7-22) 中 的 pi-po 及 式 (7-23) 中 的 n 和 9 对 于 每 段 轨迹 只 需 计 算 一 次 。 
若 目 标 结 点 在 变化 ， 则 己 也 要 改变 。 在 此 情况 下 ， 对 mm -po 和 nn，9 应 每 步 计算 一 次 。 可 用 
Taylor 提出 的 追踪 公式 来 处 理 这 一 问题 。 

若 要 求 操作 臂 工 具 由 一 段 轨迹 运动 到 另 一 段 ， 且 维持 等 加 速度 ， 则 在 两 段 之 间 必 须 加 速 
或 减速 。 为 此 在 两 段 轨 迹 的 交点 前 的 r 时 刻 开始 过 渡 ， 而 在 交点 后 的 7 时 刻 来 完成 过 渡 ， 两 
段 轨迹 的 边界 条 件 为 











TApi 
Ti-7)=pi- 

p(TI-7)=p! 7 

TAp, 
p(TI+7)=p1+ T 

? (7-25) 

Ew 
qr 9 


d Ap, 

了 (9) in 

其 中 ， Api p11 Po; Ap, =p, 一 D1 ; 用 和 7 分 别 为 通过 这 两 段 轨迹 的 时 间 。 如 果 用 等 加 速度 
过 渡 ， 则 








d2 

本人 二 你 (7-26) 

将 上 式 积 分 两 次 ， 并 代入 相应 的 边界 条 件 ， 便 可 求 出 手 部 (工具 ) 坐标 系 的 位 置 ， 即 

(7-t’)? (T+t’)? 
Api+ 

477T 477, 

其 中 ,1'=71-t 是 从 两 段 交 点 算 起 的 时 间 。 同 样 可 求 得 工具 坐标 系 的 姿态 





p(t')=p1- Ap, (7-27) 
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一 刀 2 十 刀 2 
R(1)= RiRot|m ,人 0 Rot mm | (7-28) 
1 


其 中 ，Rot(ni，91) = Ro'RI 和 Rot(n,，0,)= Ri'R, 是 四 元 数 表示 的 旋转 和 矩阵。 上 面 得 出 
工具 坐标 系 沿 直线 路 径 ， 并 在 两 段 轨 迹 之 间 平 滑 渡 过 的 位 置 和 姿态 的 表达 式 。 应 该 指出 ， 角 
加 速度 并 不 是 恒定 的 ， 除 非 n, 和 nn, 平行 或 下 列 两 个 转速 之 一 为 零 : 


0 就 0 
$= 于 = 





7.5 轨迹 的 实时 生成 


运动 轨迹 的 描述 或 生成 有 以 下 几 种 方式 : 

1) 示 教 一 再 现 运 动 。 这 种 运动 由 人 手把手 示 教 机 带 人 ， 定 时 记录 各 关节 变量 ,得 到 沿 
路 径 运 动 时 各 关节 的 位 移 时 间 函 数 g(1) ; 再 现时 ， 按 内 存 中 记录 的 各 点 的 值 产生 序列 动作 。 

2) 关节 空间 运动 。 这 种 运动 直接 在 关节 空间 里 进行 。 由 于 动力 学 参数 及 其 极限 值 直 接 
在 关节 空间 里 描述 ， 所 以 用 这 种 方式 求 最 短 时 间 运 动 很 方便 。 

3) 空间 直线 运动 。 这 是 一 种 直角 空间 里 的 运动 ， 它 便于 描述 空间 操作 ,计算 量 小 ， 适 
宜 简单 的 作业 。 

4) 空间 曲线 运动 。 这 是 一 种 在 直角 空间 中 用 明确 的 函数 表达 的 运动 ， 如 圆周 运动 、 螺 
旋 运 动 等 。 

前 面 轨 迹 规 划 的 任务 ， 是 根据 给 定 的 路 径 点 规划 出 运动 轨迹 的 所 有 参数 。 

例如 ， 在 用 三 次 多 项 式 函 数 择 值 时 ， 便 产生 出 多 项 式 系 数 oo，oi ，a,，a3， 从 而 得 到 整 
个 轨迹 的 运动 方程 : 








q(t)= antanttapt tant (7-29) 


对 式 (7-29) 进行 求 性， 可 以 得 到 速度 和 加 速度 
gf 区 = a +2aptt3ast 


q (1)= 2ap+6oal (7-30) 
7.6 基于 动力 学 模型 的 轨迹 规划 


前 面 所 述 轨迹 规划 所 生成 的 关节 矢量 g(t) ， 关 节 速 度 y(t) 和 关节 加 速度 g (1) 没有 
考虑 操作 臂 的 动力 学 特性 。 实 际 上 ， 操 作 臂 所 能 达到 的 加 速度 与 其 动力 学 性 能 、 驱 动 电动 机 
的 输出 力矩 等 因素 有 关 。 并 且 ， 多 数 电动 机 的 特性 并 不 是 由 它 的 最 大 力矩 或 最 大 加 速度 所 规 
定 的 ， 而 是 由 它 的 力矩 一 速度 关系 曲线 〈 机 械 特性 ) 决定 的 。 

在 进行 轨迹 规划 规定 各 个 关节 或 各 个 自由 度 的 最 大 加 速度 时 ， 通 常 取 比 较 保 守 的 值 ， 以 
免 超 过 驱动 装置 的 实际 负载 能 力 。 显 然 , 采用 上 述 轨迹 规划 方法 不 能 充分 利用 操作 臂 的 加 速 
度 性 能 。 因 而 ， 自 然 会 提出 最 优 规划 问题 根据 给 定 的 空间 路 径 、 操 作 辟 动力 学 和 驱动 电动 
机 的 速度 -力矩 约束 曲线 ， 求 机 械 手 的 最 佳 轨 迹 ， 使 它 达 到 目标 点 的 时 间 最 短 。 

采用 笛 卡 儿 空间 轨迹 规划 ， 路 径 约 束 是 笛 卡 儿 坐标 表示 的 ， 而 驱动 力矩 约束 是 以 关节 坐 
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标的 形式 给 出 的 。 因 此 该 优化 问题 是 带 有 坐标 系 混合 约束 的 问题 。 必 须 将 路 径 用 低 阶 多 项 式 
函数 通 近 方法 将 路 径 约 束 从 笛 卡 儿 空间 转化 为 关节 空间 ， 或 将 关节 力矩 和 关节 力 约束 转化 到 
第 卡 儿 空 间 ， 然 后 进行 轨迹 优化 和 控制 。 

时 间 最 短 的 优化 问题 则 归结 为 : 如 何 调整 各 路 径 段 的 持续 时 间 ， 使 总 的 时 间 最 短 ， 并 满 
足 速度 、 加 速度 、 加 速度 变化 和 力矩 约束 。 与 之 相对 应 的 问题 是 ， 在 给 定 的 时 间 人 允许 的 范围 
内 ， 选 择 最 优 轨 迹 ， 使 最 大 驱动 力矩 〈 力 ) 、 最 大 加 速度 、 最 大 速度 为 最 小 。 前 面 提 过 的 高 
性 能 指标 、 加 速度 性 能 指标 和 综合 性 能 指标 可 以 作为 相应 的 目标 函数 。 




















7.7 本 竟 小 结 


本 章 讲述 了 关于 轨迹 规划 的 一 般 性 问题 ， 并 且 对 关节 轨迹 规划 的 插值 和 第 卡 儿 空 间 的 规 
划 方 法 做 了 较为 详细 的 介绍 。 要 重点 擎 握 关 节 轨 迹 的 插 补 算法 以 及 稍 卡 儿 空间 的 规划 方法 ， 
对 于 四 元 数 要 有 基本 的 认识 。 





习 题 


7-1 什么 是 轨迹 规划 ? 试 前 述 一 下 PTP 控制 下 的 轨迹 规划 步 又，CP 控制 下 的 轨迹 规划 
步 又 。 简 述 轨迹 规划 的 方法 并 说 明 其 特点 。 

7-2 设 一 机 器 人 具有 6 个 转动 关节 ， 其 关节 运动 均 按 三 次 多 项 式 规划 ， 要 求 经 过 两 个 
中 间 路 径 点 后 停 在 一 个 目标 位 置 。 试 问 欲 描述 该 机 器 人 关节 的 运动 ， 共 需要 多 少 个 独立 的 三 
次 多 项 式 ? 要 确定 这 些 三 次 多 项 式 ， 需 要 多 少 个 系数 ? 

7-3” 插 补 有 哪些 分 类 方式 ?什么 是 定时 插 补 和 定 距 插 补 ? 分 别 在 什么 场合 下 应 用 ? 简 
述 插 补 的 轨迹 控制 过 程 和 箔 卡 儿 空 间 的 规划 方法 。 

7-4 单 连 杆 机 器 人 的 转动 关节 ， 从 9=-5° 静 止 开始 运动 ， 要 想 在 4s 内 使 该 关节 平滑 地 
运动 到 0=+80° 的 位 置 停止 。 试 按 下 述 要 求 确 定 运动 轨迹 : 

(1) 关节 运动 按 三 次 多 项 式 插值 方式 规划 。 

(2) 关节 运动 按 抛物 线 过 渡 的 线性 插值 方式 规划 。 

7-5 平面 2R 机 械 手 的 两 连 杆 长 为 Im， 要 求 从 (xo，yo)= (1.96，0.50) 移 到 (wj， 
yr)=(1.00,，0.75) ， 起 始 和 终止 位 置 、 速 度 、 加 速度 均 为 零 ， 求 出 每 个 关节 的 三 次 多 项 式 
的 系数 。 可 将 关节 分 成 几 段 路 径 ? 

7-6 假设 关节 路 径 点 序列 为 : 10*、35°* 、25°* 、10"， 三 个 轨迹 段 的 持续 时 间 分 别 为 2s、 
1s、3s。 各 过 渡 域 的 隐 含 加 速度 绝对 值 不 超过 50°/s*。 计 算 各 段 的 速度 、 过 渡 持 续 时 间 和 线 
性 持续 时 间 。 

7-7 机 器 人 从 点 4 沿 直线 运动 到 点 如， 其 坐标 分 别 为 














-1 0 0 10 0 -1 0 10 
jo10 10 |o 01010 
jo 0 -110 |-1 0 0 10 

0 0 0 1 0 0 0 1 


且 绕 等 效 转 轴 上 匀速 回转 等 效 角 06， 求 天 量 大 和 转角 9， 并 求 三 个 中 间 变 换 。 
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7-8 初始 状态 下 运动 坐标 系 (x’'，y’，z') 与 固定 参考 坐标 系 (x*，y，z) 一 致 ， 求 固 
定 在 运动 坐标 系 上 的 点 已 (2，7，5) 依次 经 过 下 列 变换 后 相对 于 固定 参考 坐标 系 的 坐标 。 

(1) 绕 y 轴 旋 转 90°。 

(2) 绕 x 轴 旋 转 90°。 

(3) 再 平移 [1 2 -1]。 
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本 章 主要 介绍 机 器 人 的 设计 方法 、 原 则 和 系统 设计 ， 分 析 了 机 器 人 在 焊接 、 抽 和 运 、 喷 涂 
和 装配 上 的 应 用 ， 介 绍 了 机 器 人 发 展现 状 及 发 展 趋势 。 通 过 本 章 的 学 习 ， 使 读者 掌握 机 器 人 
一 般 设计 方法 和 步骤 ， 重 点 了 解 机 器 人 的 应 用 及 发 展 。 


8.1 机 融 人 一 般 设 计 原 则 、 步 又 和 方法 





8. 1.1 机 器 人 设计 原则 和 步骤 


机 器 人 设计 是 一 个 比较 完整 的 机 电 一 体 化 整 机 设计 。 在 设计 过 程 中 ， 要 坚持 两 个 原则 : 
中 整体 性 原则 ; 包 控 制 系统 设计 优先 于 机 械 结构 设计 原则 。 

机 器 人 是 集 机 械 、 电 子 、 控 制 等 于 一 体 的 机 电 系 统 ， 所 以 设计 机 器 人 是 一 个 系统 性 的 工 
作 。 机 器 人 系统 内 任何 一 个 部 件 或 者 零件 设计 有 缺陷， 都 会 影响 机 器 人 的 整体 功能 和 性 能 。 
为 此 ， 需 首先 设计 机 器 人 的 整体 功能 和 人 参数， 然后 设计 各 个 局 部 的 部 件 和 零件 。 

在 设计 过 程 中 ， 可 能 的 设计 缺陷 是 机 器 人 的 机 械 本 体 加 工 完 成 之 后 ， 安 装 驱 动 器 、 控 制 
器 和 传感器 时 ， 发 现 预 留 的 空间 不 够 。 这 样 的 设计 错误 有 点 荒唐 ， 但 对 于 初学 者 而 言 却 是 很 
可 能 犯 的 错误 。 对 于 比较 有 经 验 的 设计 者 ， 可 能 在 机 器 人 加 工 调试 之 后 才 发 现 有 设计 缺陷 ， 
如 样机 的 控制 精度 不 够 ， 或 者 快速 响应 达 不 到 要 求 。 为 了 达到 技术 要 求 ， 修 改 控制 程序 或 者 
改变 控制 方法 并 不 能 解决 问题 ， 而 需要 修改 机 械 结构 或 者 控制 硬件 。 有 时 候 会 出 现 要 么 重新 
选择 电动 机 ， 要 么 重新 设计 机 械 结构 ， 出 现 “ 鱼 与 能 掌 不 可 兼 得 ”的 情况 ， 这 反映 了 机 器 
人 设计 整体 性 原则 考虑 不 足 。 为 了 在 原 有 的 样机 上 增加 一 个 小 的 功能 ， 往 往 会 牵 一 发 而 动 全 
身 ， 机 器 人 的 机 械 结构 和 控制 系统 等 全 部 需要 修改 或 者 重新 设计 ， 这 也 是 体现 了 机 器 人 设计 
整体 性 原则 。 所 以 说 ,设计 机 器 人 时 要 充分 考虑 各 方面 因素 ， 而 不 只 是 进行 简单 的 机 械 结构 
设计 ， 要 遵循 整体 性 原则 。 

控制 系统 设计 优先 于 机 械 结 构 设 计 原 则 。 机 器 人 的 设计 ， 首 先 应 该 是 功能 设计 ， 根 据 功 
能 要 求 提出 机 器 人 的 性 能 参数 ， 围 绕 性 能 参数 选择 控制 方案 ,确定 控制 系统 的 类 型 ， 设 计 并 
选 购 计 算 机 控制 硬件 ， 最 后 才 是 机 械 结构 设计 。 现 代 设 计 和 传统 设计 的 概念 不 一 样 ， 不 是 每 
一 个 部 件 都 需要 机 器 人 设计 者 自己 详细 的 设计 ， 更 多 的 时 候 是 对 现 有 资源 和 技术 的 整合 和 集 
成 。 例 如 ， 控 制 系统 的 设计 ， 机 融 人 设计 者 没有 必要 从 基本 电路 和 融 件 开始 自己 去 设计 控制 
器 ， 现 在 市 场 上 有 各 种 各 样 的 控制 器 件 和 模块 及 其 控制 集成 。 设 计 者 需要 做 的 是 ， 从 众多 方 
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案 中 选择 一 种 优化 方案 ， 然 后 通过 集成 设计 开发 出 需要 的 控制 器 及 系统 。 这 样 既 能 大 大 缩短 
机 器 人 研制 的 周期 ， 又 能 取长补短 。 由 于 科学 技术 的 发 展 ， 社 会 分 工 的 细 化 ,设计 者 不 可 能 
对 所 有 与 机 避 人 相关 的 技术 和 产品 都 很 熟悉 。 为 了 快速 研制 出 一 人 台 机 如 人 ,设计 者 乱 要 充分 
利用 社会 资源 。 除 了 需要 丰富 的 设计 经 验 外 ， 还 需要 熟悉 市 场 上 的 现 有 技术 和 相关 产品 。 在 
机 器 人 设计 的 过 程 中 ， 基 本 控制 硬件 大 多 采用 直接 购买 的 方式 。 控 制 方案 确定 之 后 ， 选 择 电 
动机 、 了 驱动 妖 、 控 制 板 卡 或 者 控制 计算 机 ,虽然 产品 有 成 千 上 万 种 ,但 考虑 到 成 本 、 体 积 、 
重量 、 性 能 和 功能 要 求 ， 最 终 适合 的 产品 并 不 多 ， 可 能 较 优 的 方案 只 有 一 种 。 对 于 机 械 部 
分 ， 只 要 不 违背 机 械 设 计 原 则 ， 设 计 者 可 以 随心 所 欲 地 设计 。 因 此 ， 机 器 人 设计 时 ， 需 按照 
控制 系统 设计 优先 于 机 械 结构 设计 原则 。 在 总 体 方案 设计 完成 后 ， 先 确定 控制 系统 的 子 方 
案 ， 调 研 甚至 购买 控制 硬件 之 后 才能 进行 机 械 设计 。 控 制 硬 件 都 是 灸 藤 在 机 械 结构 上 的 ， 如 
果 控 制 硬件 的 尺寸 不 知道 ， 就 谈 不 上 设计 出 精致、 巧妙 的 机 械 结 构 。 如 果 时 间 和 经 费 允 许 ， 
可 以 对 控制 硬件 进行 调试 实验 ， 验 证 选择 的 控制 方案 是 否 满足 设计 要 求 后 再 进行 机 械 设计 。 
但 这 样 做 的 缺点 就 是 ， 机 械 加 工 的 周期 往往 比较 长 ， 把 机 械 设 计 放 在 最 后 会 影响 机 器 人 总 体 
的 研制 进度 。 因 此 ， 在 基本 控制 方案 确定 之 后 ， 一 般 采 用 并 行 方式 展开 机 电 设计 工作 。 对 于 
一 些 机 器 人 设计 ， 可 购买 三 家 的 移动 载体 ， 如 移动 小 车 和 机 械 臂 等 ,那么 设计 者 要 做 的 是 将 
机 械 部 分 和 控制 部 分 集成 为 一 个 具有 实体 功能 的 机 器 人 即 可 。 随 着 计算 机 技术 (如 CAD/ 
CAMACAPP) 的 快速 发 展 ， 为 机 器 人 的 设计 提供 了 方便 条 件 ， 这 样 大 大 缩短 了 设计 周期 并 
降低 了 成 本 ， 很 多 设计 者 在 进行 具体 设计 之 前 ， 进 行 了 计算 机 仿真 设计 ， 开 发 出 虚拟 样机 ， 
为 机 器 人 后 续 的 设计 、 加 工 和 制造 提供 了 条 件 和 保障 ， 提 高 了 设计 效率 ， 减 少 了 加 工 和 制造 
费用 。 

通常 来 说 ， 机 器 人 的 设计 步骤 一 般 可 分 为 总 体 方案 设计 ， 子 系统 详细 设计 ， 机 顺 人 制 
造 、 安 装 和 调试 ， 以 及 编写 机 器 人 设计 文档 等 。 

1. 总 体 方案 设计 

1) 机 器 人 的 应 用 和 可 行 性 分 析 。 分 析 现 有 同类 机 器 人 的 产品 性 能 和 特点 ， 进 行 可 行 性 
调查 。 论 证 技术 上 是 否 先进 ， 是 否 可 行 ; 核算 经 济 上 的 成 本 和 效益 ; 评估 市 场 开发 的 前 景 。 
对 于 企业 来 说 ,设计 机 避 人 之 前 ， 应 该 明确 设计 的 机 絮 人 适用 于 什么 样 的 客户 ， 机 絮 人 应 用 
在 什么 领域 ， 实 现 什么 样 的 功能 。 对 于 高 校 或 者 研究 所 等 科研 单位 来 次， 设计 机 器 人 之 前 ， 
也 需要 明确 设计 机 器 人 的 目的 ， 是 用 来 展示 成 果 和 进行 科学 实验 ， 还 是 进行 理论 验证 等 。 因 
为 目的 不 一 样 ， 对 样机 要 求 的 功能 就 不 一 样 。 不 能 希望 设计 的 机 器 人 尽善尽美 ， 具有 所 有 机 
器 人 的 功能 。 例 如 ， 设 计 一 人 台 搬 运 机 融 人 ， 不 能 要 求 该 搬运 机 器 人 具有 所 有 的 搬运 功能 ， 只 
要 能 满足 用 户 的 某 一 要 求 即 可 。 

2) 明确 机 器 人 的 设计 要 求 。 确 定 工艺 过 程 、 动 作 要 求 和 有 关 参 数 ， 并 对 机 器 人 的 工作 
环境 进行 分 析 。 对 于 机 器 人 ， 分 析 其 工作 环境 ， 确 定 工作 空间 和 自由 度 等 。 

3) 明确 机 器 人 的 功能 要 求 、 性 能 指标 和 技术 要 求 。 通 过 查阅 国内 外 文献 和 市 场 调研 分 
析 ， 了 解 国内 外 同类 机 器 人 发 展 的 水 平和 研制 的 技术 难点 ， 结 合 机 器 人 的 工作 条 件 和 功能 
求 ， 明 确 提出 设计 的 机 器 人 具有 的 功能 、 性 能 指标 和 技术 参数 。 这 一 步 至 关 重 要 ， 因 为 后 面 
的 一 切 设计 工作 都 是 围绕 这 项 要 求 和 指标 来 做 的 。 

4) 方案 论证 比较 。 根 据 上 述 分 析 ， 初 步 提 出 奉 干 总 体 设计 方案 ,通过 对 工艺 生产 、 技 
术 和 价值 分 析 选 择 最 佳 方案 。 例 如 ， 选 择 传动 方案 、 机 器 人 运动 载体 的 移动 方式 、 传 感 器 的 


181 











































































































| 工业 机 器 人 及 其 应 用 





种 类 和 数目 、 控 制 策略 等 。 

2. 子 系统 详细 设计 

机 器 人 总 体 方案 确定 后 ， 要 进行 机 器 人 的 详细 设计 。 也 就 是 要 进行 各 个 子 系统 、 部 件 及 
零件 的 设计 。 机 器 人 包括 控制 系统 、 机 械 系 统 和 机 器 人 检测 系统 等 。 

(1) 机 器 人 机 械 系统 设计 机 带 人 的 机 械 系统 设计 ， 包 括 末端 执行 器 、 臂 部 、 胸 部 、 
机 座 和 行走 机 构 等 的 设计 。 机 器 人 机 械 系统 的 设计 不 但 要 实现 一 定 的 机 械 功 能 ， 还 应 该 具有 
一 定 的 “人 ”的 智能 。 人 的 智能 是 多 少年 来 科学 家 们 一 直 追 求 的 目标 。 但 是 ， 不 能 忽视 人 
的 美感 : 匀称 、 和 谐 和 线条 美 ， 这 些 也 是 设计 者 所 追求 的 。 在 机 械 强 度 、 刚 度 和 成 本 允许 的 
情况 下 ， 应 尽 可 能 使 机 器 人 美观 大 方 。 

机 器 人 的 机 械 系统 设计 与 一 般 传统 的 机 械 设计 相 比 ， 具 有 许多 类 似 的 方面 ， 但 是 也 有 不 
少 特殊 之 处 ， 其 特点 如 下 。 

首先 ， 从 机 构 学 的 角度 来 分 析 ， 机 器 人 的 机 械 结构 可 以 是 由 一 系列 连 杆 通过 旋转 关节 
(或 移动 关节 ) 连接 起 来 的 开 式 空间 运动 链 ， 也 可 以 是 类 似 并 联机 器 人 的 闭 式 或 混 联 空间 运 
动 链 。 

其 次 ， 机 器 人 的 链 结 构 形 式 比 起 一 般 机 构 来 说 ， 虽 在 灵巧 性 和 空间 可 达 性 等 方面 要 好 得 
多 ， 但 是 由 于 链 结构 相当 于 一 系列 悬挂 杆 件 串 接 或 并 接 在 一 起 ， 机 械 误差 和 弹性 变形 的 累 
耻 ， 使 机 器 人 的 刚度 和 精度 大 受 影响 ， 也 就 是 说 ， 这 种 形式 的 机 器 人 在 运动 的 传递 上 存在 先 
天 性 的 不 足 。 一 般 机 械 设计 主要 是 强度 设计 ， 机 器 人 的 机 械 设 计 既 要 满足 强度 要 求 ， 还 要 考 
虑 刚度 和 精度 设计 。 

再 次 ， 机 天 人 的 机 械 结构 ， 特 别 是 关节 传动 系统 ， 是 整个 机 器 人 伺服 系统 中 的 一 个 组 成 
环节 ， 因 此 ， 机 器 人 的 机 械 设计 具有 机 电 一 体 化 的 特点 。 例 如 ， 一 般 机 械 对 于 运动 部 件 的 惯 
量 控制 只 是 从 减少 驱动 功率 来 着 眼 分 析 的， 而 机 器 人 的 机 械 设 计 需 要 同时 从 机 电 时 间 常 数 、 
提高 机 器 人 快速 响应 能 力 这 一 角度 来 控制 惯量 。 再 如 ， 一 般 的 机 械 设 计 中 控制 机 械 谐 振 频率 
是 为 了 保证 不 破坏 系统 ， 而 在 机 天 人 设计 上 ， 是 从 运动 的 稳定 性 、 快 速 性 和 轨迹 精度 等 伺服 
性 能 角度 来 控制 机 械 谐振 频率 的 。 

此 外 ， 与 一 般 机 械 相 比 ， 机 器 人 的 机 械 设 计 在 结构 的 紧 竣 性 、 灵 巧 性 以 及 特殊 要 求 等 方 
面具 有 和 较 高 的 要 求 。 

在 详细 设计 机 械 系统 的 零件 图 和 装配 图 时 ， 可 以 使 用 Pro/ 丰 、USG 或 者 SolidWork 等 软件 
建立 三 维 实体 模型 ， 在 计算 机 上 进行 虚拟 装配 ， 然 后 进行 运动 学 仿真 ， 检 查 是 否 存在 运动 干 
涉 和 外 观 的 不 足 。 在 加 工 制造 之 前 ， 可 使 用 Adams 等 软件 进行 动力 学 仿真 ， 能 够 发 现 更 深 
层次 的 问题 ， 然 后 进行 修正 ， 从 而 进一步 完善 机 带 人 机 械 系统 的 设计 。 

(2) 机 器 人 控制 系统 设计 ”首先 根据 总 体 的 功能 要 求 选 择 合 适 的 机 器 人 控制 方案 。 然 
后 根据 控制 方案 选择 和 设计 机 器 人 控制 便 件 和 软件 。 

在 机 器 人 控制 系统 设计 中 ， 选 择 驱 动 方式 很 重要 。 通 常 ， 根据 机 絮 人 负载 要 求 选择 液压 
了 驱动、 气动 还 是 电动 作为 机 器 人 的 驱动 方式 ， 这 主要 取决 于 机 器 人 工作 现场 条 件 和 机 器 人 上 
能 提供 的 动力 源 类 型 。 

3. 机 器 人 制造 、 安 装 和 调试 

首先 ， 筛 选 标准 元 器 件 ， 对 自制 的 零 部 件 进 行 检查 ， 对 外 购 的 设备 器 件 进行 验收 ; 然 
后 ， 对 各 子 系统 经 调试 后 进行 总 体 安装 ， 整 机 联 调 。 对 于 传动 系统 ， 特 别 是 谐 波 传 动 ， 安 装 
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在 机 器 人 上 之 前 一 定 要 调试 ， 检 查 传 动 精度 以 及 噪声 是 否 满 足 要 求 。 对 于 机 器 人 ， 通 常 先 空 
载 调 试 ， 然 后 带 负 载 调试 。 

4. 编写 机 器 人 设计 文档 

设计 文档 并 不 是 机 器 人 设计 的 最 后 任务 ， 而 是 贯穿 于 其 设计 的 全 过 程 。 编 写 设 计 文 档 的 
过 程 ， 是 对 机 器 人 技术 进行 总 结 、 分 析 和 积累 的 过 程 。 这 些 文档 是 对 机 器 人 技术 的 积累 ， 对 
企业 或 者 科研 机 构 是 一 笔 宝 贵 的 财富 。 

设计 机 器 人 不 应 该 有 一 个 严格 的 步骤 和 设计 程序 ， 一 定 先 做 什么 ， 然 后 做 什么 。 中 间 有 
许多 反馈 的 过 程 ， 很 可 能 开始 的 设计 不 能 满足 后 来 设计 的 要 求 ， 或 者 后 来 发 现 ， 最 初 的 设计 
中 有 些 不 是 最 佳 的 方案 或 者 是 多 余 的 ， 这 时 需要 重新 修改 前 面 的 设计 ， 有 可 能 造成 一 连 串 的 
改动 。 所 以 作为 一 名 设计 者 ， 开 始 总 体 方案 设计 时 尽 可 能 考虑 全 面 ， 论 证 充分 ， 这 样 才 不 会 
出 现 很 多 不 必要 的 返工 。 


8. 1.2 机 器 人 设计 方法 


机 器 人 的 设计 方法 通常 与 计算 机 技术 的 发 展 是 紧密 相关 的 。 目 前 ， 机 器 人 设计 通常 采用 
计算 机 辅助 设计 法 、 仿 真 与 虚拟 设计 法 、 仿 生 设 计 法 等 。 

1. 计算 机 辅助 设计 法 

计算 机 辅助 设计 (CAD) 法 ， 是 通过 向 计算 机 输入 设计 资料 ， 由 计算 机 自动 地 编制 程 
序 ， 优 化 设计 方案 ， 并 绘制 出 产品 或 零件 图 的 过 程 。CAD 技术 的 应 用 ， 把 人 们 从 过 去 繁琐 
的 绘图 中 解放 出 来 ， 它 不 仅 带 给 人 们 绘图 的 便利 ， 而 且 改 变 了 整个 设计 过 程 。 这 方面 的 知识 
比较 多 ， 这 里 不 再 闭 述 ， 可 参考 计算 机 辅助 设计 方面 的 文献 。 

2. 仿真 与 虚拟 设计 法 

在 计算 机 技术 快速 发 展 的 今天 ， 机 器 人 的 设计 也 发 生 了 很 大 的 变化 ， 出 现 了 仿真 与 虚拟 
设计 。 对 于 特种 机 器 人 ， 很 多 特殊 环境 ， 如 深水 中 、 核 反应 堆 强 辐射 区 等 ， 只 能 借助 计算 机 
来 模拟 实际 的 环境 。Pro/E，UG，SolidWork ，Adams 等 计算 机 软件 的 应 用 ,已 经 使 设计 者 不 
需要 制造 出 实际 的 样机 ， 就 能 够 虚拟 仿真 机 器 人 ， 从 而 研究 机 器 人 的 运动 学 和 动力 学 等 特 
性 ， 以 及 在 计算 机 环境 下 开发 虚拟 数字 化 样机 。 计 算 机 仿真 与 虚拟 研究 ， 使 机 器 人 的 设计 时 
间 大 大 缩短 ， 使 设计 者 在 设计 阶段 就 能 发 现 以 后 有 可 能 出 现 的 一 些 问 题 ， 而 此 时 更 改 设计 方 
案 是 比较 容易 的 。 如 果 等 到 样机 已 经 制造 出 来 再 更 改 图 样 ， 就 会 花费 更 多 的 人 力 和 物力 。 

3. 仿生 设计 法 

仿生 设计 学 也 可 称 之 为 设计 仿生 学 (Design Bionics) ， 它 是 在 仿生 学 和 设计 学 的 基础 上 
发 展 起 来 的 一 门 新 兴 边 缘 学 科 。 仿 生 设 计 ， 不 仅 是 一 种 设计 方法 和 工具 的 突破 ， 而 且 是 一 种 
概念 上 的 创新 ， 是 一 种 设计 思想 。 仿 生 设 计 最 早出 现在 军工 产品 上 ， 如 雷达 、 类 人 机 器 人 
等 。 由 于 机 器 人 的 特殊 功能 要 求 和 趋向 智能 化 ， 仿 生 设 计 越 来 越 多 地 应 用 在 机 器 人 的 设 
EE; 

目前 ,仿生 设计 主要 采用 结构 仿生 和 功能 仿生 两 种 主要 方法 。 

(1) 结构 仿生 ”现代 机 器 人 的 结构 仿生 中 比较 常见 有 海洋 动物 仿生 、 蛇 类 仿生 、 变 形 
虫 仿生 和 人 体 仿生 等 。 

(2) 功能 仿生 ”机 器 人 仿生 研究 的 目的 之 一 是 实现 功能 仿生 ,使 人 造 的 机 械 能 完成 或 
部 分 实现 高 级 生物 丰富 的 功能 ， 如 思维 、 感 知 、 运 动 和 操作 等 。 功 能 仿生 包括 大 脑 功能 仿 
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生 、 感 知 仿生 和 运动 仿生 等 。 


8.2 工业 机 器 人 系统 设计 


8.2.1 系统 技术 指标 、 总 体 功 能 和 结构 方案 设计 


1. 机 器 人 技术 参数 与 指标 

在 设计 机 器 人 之 前 ， 首 先 要 确定 机 器 人 技术 参数 和 指标 。 表 示 机 器 人 特性 的 基本 参数 主 
要 有 工作 空间 、 自 由 度 、 有 效 负 载 、 运 动 精度 、 运 动 特性 、 动 态 特 性 和 经 济 性 指标 。 

2. 机 器 人 系统 总 体 功 能 和 结构 方案 设计 

机 融 人 的 设计 涉及 机 械 设计 、 传 感 技术 、 计 算 机 应 用 和 上 自动 控制 ， 是 跨 学 科 的 综合 设 
计 。 机 器 人 应 作为 一 个 系统 进行 研究 ， 从 总 体 出 发 研究 其 系统 内 部 各 组 成 部 分 之 间 ， 以 及 外 
部 环境 与 系统 之 间 的 相互 关系 。 作 为 一 个 系统 ， 机 器 人 应 具备 如 下 要 求 。 

(1) 整体 性 由 几 个 不 同性 能 的 子 系统 构成 的 机 器 人 ， 应 作为 一 个 整体 来 分 析 ， 应 具 
有 其 特定 功能 。 

(2) 相关 性 各 子 系统 之 间 相 互 依存 ， 相 互联 系 。 

(3) 目的 性 ”每 个 子 系统 都 有 明确 的 功能 ， 各 子 系统 的 组 合 方式 由 整个 系统 的 功能 
决定 。 

(4) 环境 适应 性 ”机 器 人 作为 一 个 系统 ， 要 适应 外 部 环境 的 变化 。 

在 详细 设计 之 前 ， 要 明确 所 设计 的 机 器 人 应 该 具有 哪些 功能 。 系 统 总 体 功 能 设计 是 结构 
设计 的 最 终 目 的 。 只 有 确定 了 系统 的 功能 ， 后 面 的 设计 才能 有 的 放 矢 。 

实现 既定 的 功能 ， 可 能 有 很 多 种 结构 方案 ， 应 优先 选择 简单 可 徘 的 结构 方案 。 通 过 市 场 
调研 和 对 现 有 同类 机 器 人 的 技术 分 析 ， 研 究 所 要 设计 的 机 器 人 技术 难点 和 关键 技术 。 开 始 
时 ， 可 以 提出 几 种 不 同 的 方案 ; 通过 讨论 对 比分 析 ， 经 过 充分 论证 后 ， 选 择 一 种 优化 的 结构 
方案 。 


8.2.2 机 器 人 分 系统 设计 及 实现 


1. 机 器 人 机 械 结构 分 系统 

由 于 应 用 场合 的 不 同 ， 机 顺 人 的 结构 形式 多 种 多 样 ， 各 组 成 部 分 的 驱动 方式 、 传 动 原理 
和 机 械 结构 也 有 各 种 不 同 的 类 型 。 通 常 根据 机 需 人 各 部 分 的 功能 ， 其 机 械 部 分 主要 由 下 列 各 
部 分 组 成 。 
(1) 手 部 结构 ” 指 机 带 人 为 了 进行 作业 ， 在 手腕 上 配置 的 操作 机 构 ， 有 时 也 称 为 手 扑 
部 分 或 末端 执行 器 。 如 抓 取 工 件 的 各 种 抓 手 、 取 料 器 、 专 用 工具 的 夹 持 带 等 ， 还 包括 部 分 专 
用 工具 ， 如 拧 螺 钉螺 母 机 、 喷 枪 、 焊 枪 、 切 割 头 和 测量 头等 。 

(2) 手腕 结构 ”连接 手 部 和 手臂 的 部 分 ， 其 主要 作用 是 改变 手 部 的 空间 方向 和 将 作用 
载荷 传递 到 手臂 。 

(3) 手臂 结构 “连接 机 座 和 手腕 的 部 分 ， 其 主要 作用 是 改变 手 部 的 空间 位 置 ， 满 足 机 
器 人 的 作业 空间 ， 将 各 种 载 荷 传递 到 机 座 。 

(4) 机 座 结构 机 器 人 的 基础 部 分 ， 起 支承 作用 。 对 固定 式 机 器 人 ， 直 接连 接 在 地 面 
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基础 上 ; 对 移动 式 机 器 人 ， 则 安装 在 移动 机 构 上 。 

2. 机 器 人 控制 分 系统 

机 絮 人 控制 分 系统 ， 是 机 器 人 的 重要 组 成 部 分 。 它 的 机 能 类 似 于 人 的 大 脑 。 要 与 外 围 设 
备 协 调动 作 ， 共 同 完成 作业 任务 ， 就 必须 具备 一 个 功能 完善 、 灵 敏 可 靠 的 控制 系统 。 机 器 人 
的 控制 分 系统 总 的 可 以 分 为 两 大 部 分 ， 一 部 分 是 对 其 自身 的 控制 ， 另 一 部 分 是 机 器 人 与 周边 
设备 的 协调 控制 。 

控制 分 系统 一 般 由 控制 计算 机 和 驱动 装置 伺服 控制 锅 组 成 。 后 者 控制 各 关节 的 驱动 器 ， 
使 各 关节 按 一 定 的 速度 、 加 速度 和 位 置 要 求 进 行 运动 ; 前 者 则 要 根据 作业 要 求 完 成 编程 ， 并 
发 出 指令 控制 各 伺服 驱动 装置 使 各 关节 协调 工作 ， 同 时 还 要 完成 环境 状况 、 周 边 设备 之 间 的 
信息 传递 和 协调 工作 。 

(1) 机 器 人 控制 分 系统 的 特点 ”机 器 人 控制 分 系统 的 主要 任务 是 ， 控 制 机 器 人 在 工作 
空间 中 的 运动 位 置 、 姿 态 和 轨迹 、 操 作 顺 序 及 动作 的 时 间 等 ， 其 中 有 些 项 目的 控制 是 非常 复 
杂 的 ， 这 就 决定 了 机 器 人 的 控制 分 系统 应 具有 以 下 特点 : 

1) 机 器 人 的 控制 与 其 机 构 运 动 学 和 动力 学 具有 密 不 可 分 的 关系 ， 因 此 ， 要 使 机 器 人 
的 手臂 、 手 腕 及 末端 执行 器 等 部 位 在 空间 具有 准确 的 位 姿 ， 就 必须 在 不 同 的 坐标 系 中 描 
述 它们 ， 并 且 随 着 基准 坐标 系 的 不 同 而 做 适当 的 坐标 变换 ， 要 经 常 求解 运动 学 和 动力 学 
问题 。 

2) 描述 机 器 人 状态 和 运动 的 数学 模型 是 一 个 非 线性 模型 ， 因 此 ， 随 着 机 器 人 的 运动 及 
环境 的 改变 ， 其 参数 也 在 改变 。 又 因为 机 器 人 往往 具有 多 个 自由 度 ， 所 以 引起 其 运动 变化 的 
变量 不 止 一 个 ， 而 且 各 个 变量 之 间 一 般 都 存在 耦合 问题 ， 这 就 使 得 机 器 人 的 控制 分 系统 不 仅 
是 一 个 非 线性 系统 ， 而 且 是 一 个 多 变量 系统 。 

3) 对 机 器 人 的 任 一 位 姿 ， 都 可 以 通过 不 同 的 方式 和 路 径 达 到 ， 因 此 ， 机 器 人 的 控制 分 
系统 还 必须 解决 优化 的 问题 。 

(2) 机 器 人 控制 分 系统 的 基本 功能 ”机 器 人 控制 分 系统 必须 具备 示 教 再 现 和 运动 控制 
两 个 基本 功能 。 

1) 示 教 再 现 功能 。 示 教 再 现 功能 ， 是 指 在 执行 新 的 任务 之 前 ， 预 先 将 作业 的 操作 过 程 
示 教 给 机 器 人 ， 然 后 让 机 器 人 再 现 示 教 的 内 容 ， 以 完成 作业 任务 。 

2) 运动 控制 功能 。 运 动 控 制 功能 ， 是 指 机 器 人 对 其 末端 执行 融 的 位 姿 、 速 度 、 加 速度 
等 项 的 控制 。 

(3) 机 器 人 控制 方式 ”机 器 人 的 控制 方式 有 多 种 多 样 ， 根 据 作 业 任 务 的 不 同 ， 主 要 可 
分 为 点 位 控制 和 连续 轨迹 控制 。 

(4) 机 器 人 控制 系统 组 成 ”机 器 人 的 控制 系统 ， 主 要 包括 硬件 和 软件 两 个 方面 。 

1) 硬件 。 机 器 人 控制 系统 的 硬件 ， 主 要 由 以 下 几 个 部 分 组 成 : 

QD 传 感 装置 。 机 器 人 可 感知 内 部 和 外 部 的 信息 。 其 中 ， 用 以 检测 机 器 人 各 关节 的 位 置 、 
速度 和 加 速度 等 ， 即 感知 其 本 身 状态 信息 ， 该 类 传感器 称 为 内 部 传感器 ;而 外 部 传 感 咒 ， 就 
是 所 谓 的 视觉 、 力 觉 、 触 觉 、 听 觉 和 滑 觉 等 传感器 ， 它 们 可 使 机 器 人 感知 外 部 工作 环境 和 工 
作对 象 状 态 信息 。 

Q 控制 装置 。 控 制 装置 用 来 处 理 各 种 感觉 信息 、 执 行 控制 软件 、 产 生 控 制 命令 。 一 般 

一 台 微 型 或 小 型 计算 机 及 相应 的 接口 组 成 。 
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@) 关节 伺服 驱动 部 分 。 这 部 分 主要 是 根据 控制 装置 的 指令 ， 按 作业 任务 的 要 求 驱 动 各 
关节 运动 。 

2) 软件 。 这 里 所 说 的 软件 主要 是 控制 软件 ， 它 包括 运动 轨迹 算法 和 关节 伺服 控制 算法 
及 相应 的 动作 程序 。 控 制 软件 可 以 用 计算 机 语言 来 编制 ， 由 通用 语言 模块 化 编制 形成 的 专业 
机 絮 人 语言 越 来 越 成 为 机 器 人 控制 软件 的 主流 。 

3. 机 器 人 智能 分 系统 
智能 分 系统 ， 是 目前 机 器 人 系统 中 研究 的 热点 。 它 主要 由 两 个 部 分 组 成 : 一 个 为 感知 系 
统 ， 另 一 个 为 “分 析 一 决策 一 规划 ”系统 。 前 者 主要 靠 硬 件 (各 类 传感器 ) 来 实现 ; 后 者 
主要 靠 软件 (如 专家 系统 ) 来 实现 。 至 今 已 开发 出 各 种 各 样 的 传感器 ， 而 且 已 经 实用 化 ， 
如 测量 接触 、 压 力 、 力 、 位 置 、 角 度 、 速 度 、 加 速度 、 距 离 及 物体 特性 (形状 、 大 小 、 姿 
态 、 止 凸 、 表 面 粗糙 度 、 质 量 ) 的 传感器 。 这 些 传感器 可 以 分 为 两 大 类 : 用 于 控制 机 器 人 
自身 的 内 部 传感器 和 安装 在 机 械 手 或 外 于 设备 进行 某 种 操作 所 需要 的 外 部 传感器 。 真 正 意 义 
上 的 智能 机 器 人 系统 应 具有 解决 问题 的 能 力 和 理解 知觉 信息 的 机 能 ， 能 适应 外 界 的 条 件 和 环 
境 ， 并 可 根据 人 的 指示 地 进行 必要 作业 的 系统 。 

8.2.3 机 器 人 系统 内 外 部 接口 的 设计 

1. 机 械 接 口 设计 

机 器 人 系统 内 部 和 外 部 的 机 械 结构 ， 主 要 采用 螺栓 、 螺 钉 等 连接 件 紧 定 连 接 ， 对 于 易 损 
和 需要 经 常 更 换 的 外 部 设备 ， 通 常 采用 卡 口 式 设计 ， 方 便 操 作者 对 外 部 设备 的 快速 装 件 。 

2. 通信 接口 设计 

机 器 人 的 通信 接口 ， 随 着 计算 机 、 控 制 器 和 驱动 右 的 接口 标准 发 展 而 改变 。 机 器 人 与 计 
算 机 相连 接 时 ， 如 果 通 信 距 离 较 远 采用 串 行 RS232C 通信 接口 ， 如 果 通 信和 距离 较 近 ,采用 并 
行 通 信 接 口 。 也 有 一 些 机 器 人 采用 总 线 接 口 ， 如 Can 总 线 、Fire Wire 总 线 (IEEE1394 总 
线 ) 。 机 器 人 与 各 种 传感器 之 间 主 要 采用 模拟 量 的 IO 和 数字 量 的 10 接口 ， 也 有 采用 串 行 
RS232C 接口 的 。 


8.3 ”特种 机 器 人 系统 设计 


特种 机 器 人 ， 是 指 在 非 制造 环境 下 应 用 的 机 器 人 。 它 和 工业 机 器 人 的 区 别 主要 是 功能 
环境 的 不 同 。 工 业 机 器 人 是 在 一 定 的 结构 化 环境 下 完成 一 定 的 制造 或 者 制造 铺 助 功能 ， 而 特 
种 机 器 人 一 般 都 是 在 非 结构 化 或 者 动态 环境 中 完成 某 种 特定 的 非 制造 性 功能 。 下 面 以 水 下 般 
体 表面 清 刷机 器 人 和 仿生 机 器 人 作为 特种 机 器 人 的 典型 案例 ， 以 此 来 介绍 特种 机 器 人 的 
设计 。 

8. 3. 1 仿生 机 器 人 设计 


1. 仿生 机 器 人 的 特点 、 发 展 及 关键 技术 问题 

(1) 仿生 机 器 人 的 特点 ”仿生 机 器 人 是 近 十 几 年 来 出 现 的 新 型 机 需 人 ， 它 的 思想 来 源 
于 仿生 学 ， 其 目的 是 研制 出 具有 生物 某 些 特征 的 机 器 人 。 该 机 器 人 是 仿生 学 的 先进 技术 与 机 
器 人 领域 的 各 种 应 用 的 较 佳 结合 ， 是 机 器 人 发 展 的 较 高 阶段 。 
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(2) 仿生 机 器 人 的 研究 现状 

1) 飞行 机 器 人 。 飞 行 机 器 人 ， 即 具有 自主 导航 能 力 的 无 人 驾驶 飞行 器 。 其 飞行 原理 分 
为 : 固定 辟 飞 行 、 旋 翼 飞 行 和 扑 翼 飞行。 固定 辟 技 术 已 经 成 熟 ， 但 其 翼 展 在 200mm 以 下 时 
不 足以 产生 足够 的 升力 。 目 前 国内 外 广泛 关注 的 微型 飞行 器 侧重 于 扑 辟 机 的 研究 。 它 模仿 鸟 
类 或 昆虫 的 扑 辟 飞行 原理 ， 故 被 称 为 “人 工 昆 虫 ”。 

目前 对 飞行 运动 进行 仿生 研究 的 国家 主要 是 美国 ， 英 国 剑桥 大 学 和 加 拿 大 多 伦 多 大 学 也 
在 开展 相关 方面 的 研究 工作 。 美 国 加 州 大 学 伯克利 分 校 的 研究 小 组 用 了 4 年 的 时 间 ， 基 于 仿 
生 学 原理 制造 出 了 世界 上 第 一 只 能 飞翔 的 “机 器 苍蝇 ”。 

2) 陆地 仿生 机 器 人 。 美 国 宇 航 局 (NASA) 喷气 推进 实验 室 于 2002 年 12 月 研制 成 功 
的 机 需 蜂 蛛 〈Spider-pot) ， 装 有 一 对 可 以 用 来 探测 障碍 的 天 线 ， 且 拥有 异常 灵活 的 腿 。 它 
们 能 跨越 障碍 ， 攀 登 岩石 ， 探 究 靠 轮子 滚动 前 进 的 机 器 人 无 法 抵达 的 区 域 。 

目前 世界 上 关于 仿 壁 虎 机 器 人 的 研制 还 处 在 起 步 阶段 ， 真 正 能 实现 类 似 壁虎 的 全 空间 无 
障碍 运动 的 机 器 人 还 需要 一 些 时 间 。 

3) 水 下 仿生 机 器 人 。 水 下 机 器 人 又 称 为 水 下 无 人 潜 器 ， 分 为 遥控 、 半 自治 及 自治 型 。 
水 下 机 器 人 是 典型 的 军民 两 用 技术 ， 不 仅 可 用 于 海上 资源 的 勘探 和 开发 ， 而 且 在 海战 中 也 有 
不 可 替代 的 作用 。 鱼 类 的 高 效 、 快 速 、 机 动 灵活 的 水 下 推进 方式 吸引 了 国内 外 的 科学 家 们 从 
事 仿生 机 器 鱼 的 研究 。 美 国 、 日 本 等 国 的 科学 家 们 研制 出 了 各 种 类 型 的 仿生 机 器 鱼 实 验 平台 
和 原理 样机 。 国 内 的 中 科 院 自动 化 研究 所 、 北 京 航空 航天 大 学 和 哈尔滨 工程 大 学 等 单位 已 研 
制 了 机 器 鱼 样 机 。 

(3) 研究 仿生 机 器 人 的 关键 技术 问题 

1) 建 模 问题 。 仿 生机 器 人 的 运动 具有 高 度 的 灵活 性 和 适应 性 ， 其 一 般 都 是 宛 余 度 或 超 
宛 余 度 机 器 人 ， 结 构 复 杂 ， 运 动 学 和 动力 学 模型 与 常规 机 器 人 有 很 大 差别 ， 且 复杂 程度 
更 大 。 

2) 控制 优化 问题 。 机 器 人 的 自由 度 越 多 ， 机 构 越 复杂 ， 必 将 导致 控制 系统 的 复杂 化 。 
复杂 大 系统 的 实现 不 能 全 靠 子 系统 的 堆积 ， 要 做 到 “整体 大 于 组 分 之 和 ”， 同 时 要 研究 高 效 
优化 的 控制 算法 才能 使 系统 具有 实时 处 理 能 

3) 信息 融合 问题 。 信 息 融 合 技术 把 分 布 在 不 同位 置 的 多 个 同类 或 不 同类 的 传感器 所 提 
供 的 局 部 环境 的 不 完整 信息 加 以 综合 ， 消 除 多 传感器 信息 之 间 可 能 存在 的 元 余 和 矛盾， 从 而 
提高 系统 决策 、 规 划 、 反 应 的 快速 性 和 正确 性 。 

4) 机 构 设 计 问 题 。 生 物 的 形态 经 过 千 百 万 年 的 进化 ， 其 结构 特征 极 具 合理 性 ， 而 要 用 
机 械 来 完全 仿制 生物 体 几乎 是 不 可 能 的 ， 只 有 在 充分 研究 生物 肌体 结构 和 运动 特性 的 基础 上 
提取 其 精髓 进行 简化 ， 才 能 开发 全 方位 关节 机 构 和 简单 关节 组 成 高 灵活 性 的 机 器 人 机 构 。 

5) 微 传 感 和 微 驱动 问题 。 微 型 仿生 机 器 人 的 开发 涉及 电磁 、 机 械 、 热 、 光 、 化 学 、 生 
物 等 多 学 科 。 对 于 微型 仿生 机 器 人 的 制造 ， 需 要 解决 一 些 工 程 上 的 问题 。 如 动力 源 、 驱 动 方 
式 、 传 感 集成 控制 以 及 同 外 界 的 通信 等 。 

2. 四 足 仿生 机 器 人 的 设计 

仿生 机 器 人 的 种 类 很 多 ， 在 此 仅 以 四 足 仿生 机 器 人 设计 为 例 进行 介绍 。 

(1) 样机 设计 概况 ”样机 采用 仿 四 足 哺乳 类 动物 一 一 狗 的 生理 结构 ， 并 对 其 关节 进行 
了 简化 ， 如 图 8-1 所 示 。 
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图 8-1 四 足 仿生 机 咒 狗 关节 分 布 图 
1~4 一 艇 关节 5~8 一 膝 ( 肘 ) 关节 





(2) 机 融 狗 运动 控制 算法 “算法 是 机 咒 狗 控制 系统 的 重要 组 成 部 分 之 一 ， 目 前 机 顺 狗 
的 运动 控制 算法 大 致 可 分 为 两 类 : 

1) 传统 规划 算法 。 传 统 规 划算 法 先 对 机 器 狗 本 体 建 模 ， 运 动 中 确定 目标 位 置 和 运行 速 
度 后 需 实时 地 再 建立 精确 的 环境 模型 ， 在 这 基础 上 通过 动力 学 及 运动 学 方程 的 数值 求解 ， 获 
得 各 关节 在 下 一 时 刻 的 位 置信 息 。 该 方法 适合 机 带 狗 在 结构 化 环境 下 的 运动 控制 ， 具有 算法 
成 熟 、 控 制 精度 高 等 优点 。 其 缺点 是 对 移动 机 器 狗 系 统 建 模 复杂 、 计 算 量 大 、 实 时 性 难以 保 
证 ， 同 时 在 非 结构 化 环境 中 ， 很 难 对 环境 精确 建 模 。 

2) 仿生 控制 算法 。 仿 生 控 制 算法 ， 是 模仿 生物 的 运动 机 理 来 实现 对 机 器 狗 的 运动 控 
制 ， 常 见 的 有 仿生 CPG 算法 、 遗 传 算法 、 基 于 行为 的 控制 方法 等 。 仿 生 CPG 算法 能 够 产生 
稳定 的 相位 关系 ， 实 现 步 态 的 协调 ， 不 需要 对 环境 精确 建 模 ， 具 有 算法 简单 、 易 于 计算 机 程 
序 化 、 对 地 形 的 适应 性 强 等 特点 。 目 前 该 算法 已 应 用 于 四 足 机 器 人 “Tekken” 和 
“Biosbot”， 同 时 在 仿生 机 需 鱼 、 机 器 蛇 和 双 足 机 器 人 中 已 初 见 成 效 。 遗 传 算法 是 对 生物 进 
化 机 制 的 仿生 ， 其 特点 是 具有 高 度 的 并 行 处 理 能 力 ， 重 棒 性 强 ， 易 于 实现 全 局 优化 ， 特 别 适 
用 于 非 线性 复杂 大 系统 的 优化 。 基 于 行为 控制 的 机 器 人 运动 由 一 系列 同时 发 生 的 简单 动作 或 
“能 力 ” 组 成 ， 通 过 上 自 组 织 实 现 系 统 的 复杂 行为 ， 具 有 即时 性 和 自 组 织 的 特点 ， 在 非 结构 化 
环境 中 具有 良好 的 适应 性 。 

(3) 机 顺 狗 结构 设计 “该 四 足 仿生 机 顺 狗 试验 样机 ， 和 采用 仿 四 足 动物 狗 的 生理 结构 ， 
如 图 8-2 所 示 。 狗 的 每 条 腿 由 5 段 组 成 ， 共 有 5 个 关节 ， 每 个 关节 有 1~3 个 自由 度 。 狗 腿 的 
结构 宛 余 自由 度 多 ， 在 现 阶 段 四 足 机 器 人 要 完全 模仿 这 种 结构 几乎 不 可 能 ， 只 能 通过 合理 的 
简化 ， 尽 量 让 它 接近 这 种 结构 。 目 前 研制 的 四 足 仿生 机 带 狗 试验 样机 每 条 腿 具 有 3 个 关节 ， 
分 别 是 髓 关节 、 膝 肘 关 节 和 踪 关 节 。 其 中 髓 关节 、 膝 肘 关节 为 主动 关节 ， 采 用 直流 电动 机 了 驱 
动 ; 踩 关节 为 从 动 关节 ， 关 节 上 装 有 弹簧。 

机 融 狗 试验 样机 如 图 8-3 所 示 ， 由 躯干 和 4 条 腿 组 成 。 材 质 主要 采用 铝 型 材 ， 部 分 要 求 
强度 高 的 部 件 ( 如 轴 套 ) 采用 钢 结构 。 机 器 狗 机 械 本 体质 量 约 为 10kg ( 含 电动 机 、 减 速 机 
构 )， 控 制 系统 质 量 约 为 1. 5kg。 饮 干 主体 是 一 根 横梁 ,两 端 效 有 机 架 ， 用 于 髓 关节 电动 机 
的 固定 。 四 条 腿 采用 相同 的 结构 ， 髓 关节 采用 直流 减速 电动 机 直接 驱动 。 为 了 尽量 让 每 条 腿 
上 的 惯量 匹配 ， 膝 关节 电动 机 没有 直接 安装 在 膝 关 节 上 ， 而 是 安装 在 机 器 狗 大 腿 的 另 一 侧 ， 
距离 通关 节 9cm 处 ， 电 动机 经 齿轮 式 减 速 右 减速 后 通过 带 轮 传动 。 躁 关节 是 一 个 从 动 关 节 ， 
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图 8-2 狗 的 骨骼 示意 图 
1 一 上 颌 骨 2 一 辣 骨 3 一 顶 骨 4 一 下 颌 骨 5 一 第 一 颈椎 ( 赛 椎 ) 6 一 第 二 颈椎 ( 枢 椎 ) 7 一 胸椎 ”8 一 腰椎 
9 一 尾 椎 10 一 户 有 骨 ” ”11 一 肽 骨 ” ”12 一 骨 ”13 一 尺骨 ”14 一 腕 骨 ”15 一 掌骨 ”16 一 指骨 ”17 一 胸骨 ”18 一 骼 骨 
19 一 坐骨 ”20 一 股骨 ”21 一 艇 骨 22 一 肥 骨 ”23 一 腓骨 ”24 一 跟 突 25 一 踢 骨 26 一 贵 骨 ”27 一 趾 骨 



































没有 用 电动 机 驱动 ， 而 是 通过 扭 簧 连接 。 采 用 硫化 方法 ， 在 机 器 狗 足 底 安装 有 橡胶 块 ， 以 减 
小 地 面 对 机 器 狗 的 冲击 ， 提 高 机 器 狗 的 柔性 。 

(4) 机 器 狗 控 制 系统 设计 

1) 机 融 狗 控制 系统 由 以 下 三 大 功能 模块 组 成 。 

QD 机 器 狗 规 划 、 决 策 模块 。 根 据 外 部 给 定 的 目标 任务 ， 借 助 各 类 传感器 ， 确 定 机 器 狗 
的 行走 路 线 。 

Q 多 关节 协调 控制 模块 。 将 机 器 狗 的 任务 分 解 到 各 个 关节 ， 通 过 多 着 的 协调 运动 来 
完成 具体 的 行走 任务 。 

(3 单 关节 运动 控制 模块 。 通 过 对 机 融 狗 驱动 器 的 伺服 控制 ， 驱 动 关 节 完 成 运动 。 

这 三 大 功能 模块 分 别 完成 不 同 的 











任务 ， 模 块 间 相互 联系 ， 需 要 交换 数 前 有 
据 。 整 个 控制 系统 是 一 个 多 层次 、 多 
级 别 的 复杂 系统 。 为 了 实现 对 多 个 层 
次 的 单独 控制 以 及 不 同 层次 的 协调 管 — 


理 , 将 控制 系统 分 解 为 多 个 子 系统 ， 
不 同 层 次 上 用 单独 的 控制 器 控制 ,各 
层次 间 通 过 通信 来 交换 数据 ， 即 采用 
递 阶 分 布 式 控制 系统 结构 ， 如 图 8-4 
所 示 。 上 
2) 控制 系统 共 分 为 三 层 ， 号 航 图 8-3 机 器 狗 的 结构 示意 图 

和 路 径 规 划 层 、 关 节 运 动 规划 层 和 运 

动 执 行 层 。 导 航 和 路 径 规 划 层 是 任务 规划 层 ， 根 据 高 层 的 命令 ， 结 合 传感器 对 环境 的 感知 信 
息 生 成 机 带 狗 的 行走 路 线 ; 关节 运动 规划 层 将 上 层 的 任务 转化 为 多 关节 的 协调 步 态 ， 将 步 态 
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图 8-4 机 器 狗 弟 阶 分 布 式 控制 系统 结构 


言 息 细 分 到 各 个 关节 伺服 控制 器 ， 在 机 顺 狗 运行 过 程 中 通过 对 环境 的 感知 ， 对 步 态 做 出 适当 
的 调整 ;运动 执行 层 是 控制 系统 的 底层 ， 负 责 执行 具体 的 动作 命令 。 


8. 3.2 水 下 船体 表面 清 刷机 器 人 设计 


水 下 船体 表面 清 刷机 器 人 是 用 于 水 下 10m 以 浅 船 体 表面 自动 清 刷 的 ， 这 对 于 延长 船舶 
的 使 用 寿命 、 提 高 航速 、 节 省 燃油 消耗 和 降低 潜水 员 的 劳动 强度 具有 重要 的 作用 。 根 据 该 机 
器 人 的 技术 指标 和 作业 环境 的 要 求 ， 以 及 国内 外 水 下 清 刷 技术 发 展 情况 ， 设 计 了 水 下 船体 表 
面 清 刷 机 器 人 。 

1. 水 下 船体 表面 清 刷机 器 人 的 技术 要 求 、 组 成 和 工作 原理 

(1) 水 下 船体 表面 清 刷机 器 人 的 技术 要 求 

1) 工作 环境 : 水 下 10m 以 浅 船 体 表面 。 

2) 负重 能 力 : 不 小 于 300N。 

3) 移动 速度 . 0~8m/min。 

4) 控制 方式 ， 有 线 遥 控 。 

(2) 水 下 船体 表面 清 刷机 器 人 的 组 成 及 工作 
原理 ”水 下 船体 表面 清 刷机 器 人 主要 由 交流 伺服 
电动 机 驱动 系统 、 磁 吸附 系统 、 控 制 系统 和 清 刷 
作业 装置 等 组 成 ， 如 图 8-5 所 示 。 

水 下 船体 表面 清 刷机 器 人 的 工作 原理 ;机 器 
人 在 船体 表面 的 运动 由 两 个 伺服 电机 驱动 ， 具 有 
两 个 自由 度 。 其 中 ， 一 个 自由 度 是 沿 机 器 人 中 轴 
线 的 移动 ， 另 一 个 是 靠 这 两 个 伺服 电动 机 的 转速 
差 实现 的 转弯 运动 。 机 器 人 通过 吸附 装置 吸附 在 
船体 。 机 器 人 按照 预定 的 罗 迹 携带 清 刷 作 业 装 置 ， “图 8-5 水 下 船体 表面 清 刷机 器 人 示意 图 
一 边 移动 一 边 清 刷 ， 直 至 完成 清 刷 作业 任务 。 

2. 机 械 本 体 方案 设计 

(1) 机 器 人 吸附 方式 的 选择 “水 下 船体 表面 清 刷机 器 人 按 吸附 功能 来 分 有 真空 吸附 、 
磁 吸 附和 推力 吸附 三 类 。 真空 吸附 法 有 单 吸盘 和 多 吸盘 两 种 。 它 是 通过 真空 泵 装置 ， 使 吸盘 
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内 朋 产 生 负 压 或 由 喷射 名 经 喷嘴 将 压缩 空气 喷 出 ， 在 其 周 于 形成 真空 ， 使 机 器 人 吸附 在 壁面 
上 。 它 不 受 壁 面 材料 的 限制 ， 但 当 壁 面 凹凸 不 平时 ， 吸 盘 容 易 漏 气 ， 降 低 了 吸附 力 和 承载 
力 。 磁 吸附 法 分 永 磁体 和 电磁 体 两 种 ， 它 要 求 壁面 必须 是 导 磁 材料 ， 对 壁面 的 凹凸 适应 性 
强 ， 不 存在 漏 气 问题 且 结 构 简 单 。 当 壁面 是 导 磁 材料 时 优先 考虑 选用 磁 吸附 。 推 力 吸附 法 是 
一 种 新 型 的 吸附 方式 ， 与 真空 吸附 和 磁 吸 附 相 比 ， 在 怜 壁 机 器 人 的 载体 方面 有 了 很 大 的 创 
新 。 它 不 是 依靠 吸力 而 是 借鉴 了 航空 技术 ,使 用 螺旋 桨 或 涵 道 风扇 产生 合适 的 推力 ， 使 机 器 
人 稳定 可 靠 地 吸附 在 壁面 上 ， 由 于 推力 能 始终 指向 壁面 ， 机 器 人 可 容易 地 实现 越 障 而 适应 于 
各 种 情况 的 壁面 。 考 虑 到 船体 表面 是 导 磁 性 材料 ， 且 附着 海 生物 的 船体 表面 凹凸 不 平 ， 为 了 
提高 吸附 力 ， 选 用 磁 吸附 法 。 由 于 用 永 磁体 维持 吸附 力 不 需 要 外 加 能 量 ， 也 不 会 因 控制 部 件 
发 生 故 障 而 脱离 壁面 ， 所 以 采用 永 磁体 吸附 。 

(2) 机 器 人 移动 方式 的 选择 ”对 于 壁面 爬 行 机 器 人 ， 其 移动 方式 有 车 轮 式 、 履 带 式 和 步 
行 式 三 种 方式 。 其 中 ,步行 式 机 带 人 ， 重 心 比较 高 ， 动 作 较 慢 ， 而 且 水 阻力 较 大 。 

轮 式 机 器 人 虽然 具有 运动 灵活 性 的 特点 ， 但 永 磁 轮 与 船体 表面 的 接触 为 线 接触 ， 相 对 于 
面 接触 的 磁 吸 盘 而 言 ， 产 生 的 磁 吸 附 力 较 小 。 

履带 的 移动 方式 与 轮 式 相 比 ， 虽 然 结构 上 比较 复杂 ， 但 其 接触 面 大 、 重 心 低 、 稳 定 、 可 增 
加 负重 ， 而 且 便 于 携带 作业 工具 。 将 永 磁 块 馈 在 链条 上 形成 磁性 履带 ， 通 过 合理 的 设计 履带 结 
构 ， 可 以 使 履带 负重 的 大 小 与 其 上 所 镶 暴 的 磁 块 数量 近似 成 正比 ， 这 样 可 保证 在 增加 吸附 力 的 
同时 ， 又 可 灵活 地 适应 壁面 。 由 于 履带 是 贸 链 连接 的 ， 具有 一 定 的 柔性 ， 能 够 适应 船体 表面 的 
曲率 变化 ， 而 且 可 越过 焊 颖 等 存在 于 船体 表面 的 障碍 ， 所 以 机 器 人 采用 履带 的 移动 方式 。 

(3) 机 老人 驱动 方式 的 选择 ”机 融 人 按 驱 动 方式 可 分 为 液压 驱动 、 气 压 驱 动 和 电动 驱动 
等 。 对 于 高 速 重 载 的 机 器 人 ， 采 用 液压 驱动 比较 合理 ， 其 运动 平稳 ， 而 且 负 载 能 力 大 。 但 液 
压 油 源 及 油箱 结构 较为 复杂 ， 而 且 需 要 拖 着 又 长 、 又 沉 的 液压 管 路 ,限制 了 水 下 船体 表面 清 
刷机 器 人 的 活动 空间 。 气 动 的 特点 是 因 其 具有 可 压缩 性 ， 通 常用 于 机 器 人 手 爪 的 驱动 。 电 动 
了 驱动 主要 有 步 进 电 动机 、 直 流体 服 电 动机 和 交流 伺服 电动 机 。 考 虑 水 下 船体 表面 清 刷 机 器 人 
的 特殊 作业 环境 ， 驱 动机 构 选用 交流 伺服 电动 机 了 驱动。 该 电动 机 具有 全 封闭 结构 ， 而 且 具 有 
可 靠 性 高 、 转 子 的 转动 惯量 小 、 系 统 的 快速 性 好 、 同 功率 下 质量 和 体积 均 较 小 等 优点 。 

交流 伺服 电动 机 是 高 转速 、 低 转 和 矩 的 驱动 部 件 ， 电 动机 的 输出 轴 要 经 过 减速 器 进行 减 
速 ， 才 能 得 到 所 需 的 转速 和 转 和 矩 。 可 选用 精密 行星 齿轮 箱 作 为 减速 器 。 

(4) 机 器 人 密封 及 防腐 方案 的 选择 ”水 下 船体 表面 清 刷机 器 人 工作 在 海水 里 ， 必 须 对 机 
器 人 采取 一 定 的 保护 措施 ， 防 止 海水 的 渗入 和 抵抗 海水 的 侵蚀 。 由 于 海风 、 海 浪 、 潮 汐 激 起 
海水 不 断 流动 ， 构 成 力学 和 电化 学 因素 共同 作用 的 腐蚀 环境 ， 机 器 人 在 海水 中 容易 发 生 应 力 
腐蚀 、 疲 劳 腐 蚀 、 冲 蚀 和 空 蚀 等 。 在 选用 材料 时 ， 要 优先 考虑 选用 耐 海水 腐蚀 的 材料 ， 如 不 
锈 钢 、 防 腐 铝 合金 等 ， 还 有 非 金属 耐 海 水 腐蚀 材料 ， 如 特种 尼龙 、 丁 且 橡 胶 等 。 整 机 装配 
后 ， 喷 涂 防 腐 涂 料 和 防止 海洋 生物 吸附 的 防 污 漆 ， 以 防止 海水 腐蚀 和 附着 海洋 生物 。 

密封 是 指 能 阻止 泄漏 的 方法 。 它 的 原理 是 采用 某 种 特制 的 机 构 ， 以 彻底 切断 泄漏 通道 的 
方法 ， 达 到 阻止 泄漏 的 目的 。 密 封 分 静 密 封 和 动 密 封 。 机 器 人 工作 在 海水 里 ， 关 密封 可 采用 
以 丁 膊 橡胶 为 材质 的 0 形 圈 进行 密封 。0 形 圈 密封 具有 结构 紧凑 、 寿 命 长 、 装 拆 方便 、 密 
封 性 能 好 的 特点 。 

在 设计 水 下 船体 清 刷机 器 人 动 密封 结构 时 ， 遇 到 了 一 个 技术 难题 ， 机 器 人 所 用 的 伺服 电 
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动机 的 控制 元 件 为 光 感 元 件 ， 不 能 采用 压力 补偿 式 密封 ,伺服 电动 机 输出 轴 的 轴 向 密封 尺寸 
较 小 时 ， 也 不 能 采用 机 械 密封 ， 要 更 换 水 下 电动 机 ， 会 使 制造 成 本 大 幅度 地 增加 。 经 过 分 析 
研究 ， 决 定 在 电动 机 的 输出 轴 端 加 一 个 轴 套 ,然后 再 采用 0 形 疾 和 特 康 T40 材质 滑 环 组 合 
密封 的 形式 一 一 特 康 旋转 格 莱 圈 进 行 密封 ， 这 种 结构 具有 结构 简单 、 轴 向 尺寸 小 和 抗 磨损 性 
强 的 特点 。 

(5) 机 器 人 清 刷 装置 的 方案 ”水 下 清 刷 装置 是 水 下 船体 表面 清 刷 机 器 人 的 执行 机 构 。 
机 器 人 携带 三 把 刷 具 同时 工作 ， 清 刷 效率 较 高 。 每 把 刷 具 由 水 下 电动 机 、 减 速 器 、 轴 、 滑 动 
轴承 、 联 轴 器 、 刷 具 及 支架 等 组 成 。 刷 盘 选 用 铝 合 金 制作 ， 由 锁 紧 螺母 固定 在 轴 上 。 支 架 采 
用 铝 合 金 制 成 。 为 达到 高 效率 的 清 刷 效果 ， 要 求 刷 丝 具 有 合理 的 硬度 和 弹性 。 

3. 机 器 人 控制 系统 方案 

水 下 船体 表面 清 刷 机 器 人 的 控制 系统 采用 二 级 计算 机 控制 方案 ， 如 图 8-6 所 示 。 上 位 机 
位 于 船 甲 板 的 运载 小 车 上 ， 完 成 人 机 界面 的 交互 、 环 境 初 始 值 的 输入 、 作 业 任 务 的 指定 、 路 
径 的 规划 和 机 器 人 的 状态 显示 等 。 下 位 机 位 于 机 器 人 的 载体 上 ， 接 收 来 自 上 位 机 的 指令 ， 控 
制 移动 机 构 和 清 刷 作业 装置 的 工作 等 。 控 制 器 内 部 由 两 个 伺服 电动 机 了 驱动器、 直流 电源 模 
块 、 倾 角 传感器 和 控制 电路 板 等 组 成 。 





















































图 8-6 机 器 人 控制 系统 示意 图 


综 上 所 述 ， 根 据 陆地 上 壁面 移动 机 器 人 的 发 展 状况 和 在 海洋 中 作业 的 这 一 特殊 环境 ， 设 
计 了 水 下 船体 表面 清 刷机 器 人 的 总 体 方案 ， 为 该 机 器 人 详细 设计 、 制 造 提供 了 保障 。 


8.4 机 大 人 的 应 用 





8.4.1 机 器 人 应 用 准则 及 步骤 


机 器 人 的 应 用 准则 为 : 
1) 应 当 从 恶劣 环境 和 工种 开始 执行 机 带 人 计划 。 
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2) 考虑 在 生产 率 落 后 的 部 门 应 用 机 器 人 。 

3) 要 估计 长 远 发 展 需要 。 

4) 使 用 费用 与 机 器 人 不 成 正比 。 

5) 力求 简单 实效 准则 。 

6) 确保 人 员 和 设备 安全 准则 。 

7) 不 要 期 望 卖主 提供 全 套 承包 服务 准则 。 

8) 不 要 忘记 机 器 人 需要 人 准则 。 

机 器 人 的 应 用 步 又 为 : 

1) 全 面 考虑 并 明确 自动 化 要 求 。 

2) 制订 机 器 人 化 技术 。 

3) 探讨 采用 机 器 人 的 条 件 。 

4) 对 辅助 作业 和 机 器 人 性 能 进行 标准 化 。 

5) 设计 机 器 人 化 作业 系统 方案 。 

6) 选择 适宜 的 机 器 人 系统 评价 指标 。 

7) 详细 设计 和 具体 实施 。 

机 器 人 技术 作为 21 世纪 人 类 伟大 的 发 明之 一 。 自 20 世纪 60 年 代 初 问世 以 来 ， 经 历 40 
多 年 的 发 展 已 取得 长 足 的 进步 。 机 器 人 在 经 历 了 诞生 一 成 长 一 成 熟 期 后 ， 已 成 为 制造 业 中 不 
可 少 的 核心 装备 ， 世 界 上 约 有 近 百 万 台 机 器 人 正 与 工人 并 肩 工作 在 各 条 战线 上 。 并 且 数 量 还 
在 飞速 增长 中 。 

下 面 主要 介绍 典型 的 焊接 机 融 人 、 搬 运 机 器 人 人、 喷涂 机 器 人 和 装配 机 器 人 等 的 应 用 。 


8.4.2 焊接 机 器 人 系统 组 成 及 应 用 


焊接 机 器 人 是 在 机 器 人 的 末 轴 法 兰 上 装 接 焊 钳 或 焊 〈 割 ) 枪 ， 使 之 能 进行 焊接 、 切 割 
或 热 喷 涂 的 机 器 人 。 目 前 焊接 机 器 人 是 机 器 人 应 用 领域 中 较 大 的 范畴 之 一 ， 占 机 融 人 总 数 的 
25% 左 右 。 焊 接 机 器 人 具有 焊接 性 能 可 靠 、 爆 缝 质量 优良 、 焊 接 参 数 调 整 方 便 、 生 产 率 高 、 
柔性 好 等 特点 ， 可 焊接 多 种 多 样 的 产品 ， 能 灵活 调整 生产 安排 。 

在 工业 发 达 国 家 ， 焊 接 机 器 人 已 获得 广泛 应 用 ， 如 汽车 工业 、 航 天 、 船 舶 、 机 械 加 工行 
业 、 电 子 电 气 行业 及 其 他 相关 制造 业 等 诸多 领域 ,是 制造 业 中 无 可 替代 的 先进 装备 和 手段 ， 
并 成 为 衡量 一 个 国家 制造 水 平和 科技 水 平 的 重要 标志 之 一 。 

我 国 的 焊接 机 器 人 起 步 较 晚 ， 于 20 世纪 70 年 代 末 才刚 起 步 研 究 焊接 机 器 人 ,在 80 年 
代 研 制 出 了 我 国 第 一 台 弧 焊 焊 接 机 器 人 和 点 焊 机 器 人 ， 经 过 二 十 多 年 机 器 人 焊接 技术 的 应 用 
实践 ， 国 内 焊接 机 器 人 应 用 已 初 具 规 模 。 

1. 焊接 机 器 人 系统 组 成 

完整 的 焊接 机 带 人 系统 如 图 8-7 所 示 ， 一 般 由 以 下 几 部 分 组 成 : 机 械 手 、 变 位 机 、 控 制 
帮 、 焊 接 系统 (专用 焊接 电源 、 焊 枪 或 焊 钳 等 )、 焊 接 传 感 融 、 中 央 控 制 计算 机 和 相应 的 安 
全 设备 等 。 

2. 焊接 机 器 人 的 主要 结构 形式 及 性 能 

焊接 用 机 器 人 基本 上 都 属于 关节 式 机 器 人 ， 绝 大 部 分 有 6 个 轴 。 其 中 ，1、2、3 轴 可 将 
末端 工具 送 到 不 同 的 空间 位 置 ， 而 4、5、6 轴 解 决 工具 姿态 的 不 同 要 求 。 焊 接 机 器 人 本 体 的 
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机 械 结构 主要 有 两 种 形式 : 一 种 为 平行 杆 型 机 构 ， 一 种 为 多 关 市 型 机 构 ， 如 图 8-8 所 示 。 
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图 8-7 ”焊接 机 器 人 系统 组 成 示意 图 
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图 8-8 焊接 机 器 人 基本 结构 形式 
a) 平行 杆 型 机 构 b) 多 关节 型 机 构 


多 关节 型 机 构 的 主要 优点 是 ， 上 、 下 臂 的 活动 范围 大 ， 使 机 器 人 的 工作 空间 几乎 能 达 一 
个 球体 。 因 此 ， 这 种 机 器 人 可 倒挂 在 机 架 上 工作 ， 以 节省 占 地 面积 ,方便 地 面 物件 的 流动 。 
但 是 这 种 结构 形式 的 机 器 人 ，2、3 轴 为 悬臂 结构 ， 降 低 了 机 器 人 的 刚度 ， 一 般 适 用 于 负载 
较 小 的 机 器 人 ， 用 于 电弧 焊 、 切 割 或 喷涂 。 

平行 杆 型 机 器 人 的 工作 空间 能 达到 机 咒 人 的 顶部 、 背 部 及 底部 ， 又 没有 多 关节 型 机 咒 人 
的 刚度 问题 ， 从 而 得 到 普遍 的 重视 ， 不 仪 适合 于 轻型 机 絮 人 ， 也 适合 于 重型 机 器 人 。 

3. 点 焊 机 器 人 

点 焊 机 右 人 (Spot Welding Robot) 是 用 于 点 焊 自动 作业 的 机 右 人 。 该 机 器 人 由 机 占 人 
本 体 、 计 算 机 控制 系统 、 示 教 盒 和 点 焊 焊 接 系统 几 部 分 组 成 ， 如 图 8-9 所 示 。 点 焊 机 器 人 机 
械 本 体 一 般 具 有 六 个 自由 度 : 腰 转 、 大 臂 转 、 小 臂 转 、 胶 转 、 腕 摆 及 腕 信仰 运动 。 其 驱动 方 
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式 有 液压 驱动 和 电气 驱动 及 气压 驱动 ， 其 中 电气 驱动 应 用 更 为 广泛 。 
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图 8-9 点 焊 机 器 人 的 组 成 示意 图 


1 一 机 械 臂 ”2 一 进 水 、 出 水 管线 ”3 一 焊 钳 ”4 一 电极 修整 装置 5 
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7 一 点 焊 定时 器 ”8 一 机 器 人 控制 柜 9 一 安全 围栏 
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点 焊 作 业 对 所 用 机 器 人 的 要 求 不 是 很 高 。 因 为 点 焊 只 需 点 位 控制 ， 至 于 焊 钳 在 点 与 点 之 
间 的 移动 轨迹 没有 严格 要 求 ， 这 也 是 机 器 人 最 早 只 能 用 于 点 焊 的 原因 。 点 焊 机 天 人 需要 有 足 
够 的 负载 能 力 ， 而 且 在 点 与 点 之 间 移 位 时 速度 要 快捷 ， 动 作 要 平稳 ， 定 位 要 准确 ， 以 减少 移 


位 的 时 间 ， 提 高 工作 效率 。 


工业 领域 引入 点 焊 机 器 人 可 以 取代 繁重、 单调 、 重 复 的 体力 劳动 ; 能 更 好 地 保证 焊 点 质 
量 ; 可 长 时 间 重 复工 作 ， 提 高 工作 效率 30% 以 上 ; 可 以 组 成 柔性 自动 生产 系统 ， 特 别 适合 








新 产品 开发 和 多 品种 生产 ， 增 强 企业 应 变 能 力 。 


在 我 国 ， 电 焊 机 器 人 约 占 焊 接 机 器 人 的 46% ， 主 要 应 用 在 汽车 、 农 机 、 摩 托 车 等 行业 。 


通常 ， 装 配 一 台 汽 车 车 身 需 要 完成 4000 ~ 5000 个 焊 点 ， 机 器 
人 可 完成 90% 以 上 的 焊 点 ， 仅 少数 焊 点 因 机 器 人 无 法 深入 机 
体内 部 而 需 手 工 完成 。 

随 着 汽车 工业 的 发 展 ， 焊 接生 产 线 要 求 焊 钳 一 体 化 ,其 
质量 越 来 越 大 ，165kg 点 焊 机 器 人 是 目前 汽车 焊接 中 最 常用 
的 一 种 机 器 人 ， 国 外 点 焊 机 器 人 已 经 有 200kg、 甚 至 负载 更 
大 的 机 器 人 。2008 年 9 月 ， 哈 工大 机 器 人 研究 所 研制 完成 国 
内 首 台 165kg 级 点 焊 机 器 人 ， 并 成 功 应 用 于 奇瑞 汽车 焊接 车 
间 。 经 过 优化 和 性 能 提升 的 第 二 台 机 器 人 研制 成 功 并 顺利 通 
过 验收 ， 该 机 器 人 整体 技术 指标 已 经 达到 国外 同类 机 器 人 水 
平 ， 如 图 8-10 所 示 。 

4. 弧 焊 机 器 人 

弧 焊 机 器 人 是 可 以 进行 自动 弧 焊 的 机 器 人 。 中 国 在 20 世 




















图 8-10 ”点 焊 机 右 人 示意 医 











195 

















| 工业 机 器 人 及 其 应 用 





纪 80 年 代 中 期 研制 出 华 字 - 工 型 弧 焊 机 器 人 。 一 般 的 弧 焊 机 器 人 由 示 教 盒 、 控 制 器 、 机 器 人 
本 体 及 自动 送 丝 装 置 、 焊 接 电源 等 部 分 组 成 ， 可 以 在 计算 机 的 控制 下 实现 连续 轨迹 控制 和 点 
位 控制 ， 还 可 以 利用 直线 插 补 和 圆 弧 插 补 功能 ， 
焊接 由 直线 及 圆 弧 所 组 成 的 空间 焊 颖 。 弧 焊 机 器 ee 
人 主要 有 熔化 极 焊接 作业 和 非 熔化 极 焊 接 作业 两 > 

种 类 型 ， 具 有 可 长 期 进行 焊接 作业 ， 保 证 焊接 作 
业 的 生产 率 、 质 量 和 稳定 性 等 特点 。 

随 着 技术 的 发 展 ， 弧 焊 机 器 人 正 向 着 智能 化 
的 方向 发 展 ， 采 用 激光 传感器 实现 焊接 过 程 中 的 
焊 颖 跟踪 ， 提 升 焊接 机 器 人 对 复杂 工件 进行 焊接 
的 柔性 和 适应 性 ， 结 合 视 觉 传感器 离线 观察 获得 ” 医 忆 2 Wi 
焊 颖 跟踪 的 残余 偏差 ， 基 于 偏差 统计 获得 补偿 数 出 号 诛 岂 机 中信 永 总 图 
据 并 进行 机 器 人 运动 轨迹 的 修正 ， 在 各 种 工 况 下 
都 能 获得 最 佳 的 焊接 质量 。 国 内 新 松 机 器 人 公司 已 经 开发 出 RH6 弧 爆 机器人， 并 进行 了 小 
批量 生产 ， 焊 接 质量 达到 了 国外 同类 机 器 人 产品 的 水 平 ， 如 图 8-11 所 示 。 

5. 焊接 机 器 人 技术 发 展 趋势 

(1) 多 传感器 信息 智能 融合 技术 ”近年 来 ， 随 着 机 器 人 系统 中 使 用 的 传感器 种 类 和 数 
量 越 来 越 多 ， 各 种 新 型 传感器 不 断 出 现 。 例 如 ， 超 声波 触觉 传感器 、 静 电 电 容 式 距离 传 感 
器 、 基 于 光纤 陀螺 惯性 测量 的 三 维 运动 传感器 ， 以 及 具有 焊接 工件 检测 、 识 别 和 定位 功能 的 
视觉 系统 等 。 但 是 ， 单 一 传 感 信号 难以 保证 输入 信息 的 准确 性 和 可 靠 性 ， 不 能 满足 智能 机 器 
人 系统 获取 环境 信息 和 系统 决策 能 力 的 要 求 。 为 了 有 效 利用 这 些 传感器 的 信息 ， 需 要 对 不 同 
信息 进行 综合 处 理 ， 从 多 种 传感器 信息 中 获取 单一 传感器 不 具备 的 新 功能 和 新 特点 ， 即 多 传 
感 器 智能 信息 融合 技术 。 利 用 各 种 传 感 信息 ， 获 得 对 环境 的 正确 理解 ， 使 机 器 人 系统 共有 容 
错 性 ， 保 证 系统 信息 处 理 的 快速 性 和 正确 性 。 

(2) 虚拟 现实 技术 “虚拟 现实 技术 ， 是 一 种 对 事件 的 现实 性 从 时 间 和 空间 上 进行 分 解 
后 重新 组 合 的 技术 。 这 一 技术 包括 三 维 计算 机 图 形 学 技术 、 多 功能 传感器 的 交互 接口 技术 以 
及 高 清晰 度 的 显示 技术 。 虚 拟 现实 技术 可 应 用 于 遥控 机 器 人 和 临场 感 通信 等 。 基 于 多 传 感 
器 、 多 媒体 和 虚拟 现实 以 及 临场 感 技术 ， 实 现 机 器 人 的 虚拟 融 操 作 和 人 机 交互 。 虚 拟 现实 技 
术 可 以 模拟 焊接 过 程 。 先 在 计算 机 上 完成 焊接 过 程 ， 然 后 将 工艺 过 程 转化 为 数字 化 操作 ， 再 
由 数字 化 操作 指导 实际 生产 。 通 过 建立 生产 加 工 的 仿真 模型 研究 制造 活动 ， 使 用 户 在 设计 阶 
段 就 能 够 了 解 产品 未 来 的 焊接 过 程 ， 从 而 实现 对 生产 系统 性 能 的 有 效 预测 评价 。 在 仿真 环境 
下 的 试 运行 ， 有 利于 进行 多 工艺 方案 比较 ， 更 有 利于 多 机 器 人 焊接 轨迹 的 选取 与 优化 。 

(3) 多 智能 焊接 机 器 人 系统 “多 智能 机 器 人 系统 (MARS) ， 是 近年 来 开始 探索 的 又 一 
项 智能 技术 ， 它 是 在 单 体 智能 机 器 发 展 到 需要 协调 作业 的 条 件 下 产生 的 。 多 个 机 器 人 主体 具 
有 共同 的 目标 ， 完 成 相互 关联 的 动作 或 作业 。 在 构建 系统 时 ， 不 追求 单个 、 庞 大 、 复 杂 的 体 
系 ， 而 是 按 控制 应 用 的 要 求 ， 从 功能 、 物 理 或 时 间 上 划分 成 多 个 具有 一 定 自主 能 力 的 智能 
体 ， 各 智能 体 之 间 相互 通信 ， 彼 此 协调 ， 共 同 完成 复杂 系统 的 控制 作业 任务 ， 解 决 一 个 全 局 
性 问题 。MARS 的 作业 目标 一 致 ， 信 息 资 源 共 享 ， 各 个 局 部 (分 散 ) 运动 的 主体 在 全 局 前 
提 下 感知 、 行 动 、 受 控 和 协调 ， 是 群 控 机 器 人 系统 的 发 展 。 其 目标 是 将 大 的 、 复 杂 的 硬件 或 
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软件 系统 构造 成 相对 较 小 的 、 独 立 的 、 彼 此 相互 通信 及 协调 的 、 易 于 管理 的 多 个 智能 体系 
统 。MARS 系统 在 制造 业 中 的 应 用 研究 正 不 断 成 熟 ， 这 种 趋势 表明 了 多 种 智能 自治 主体 间 的 
相互 协调 、 合 作 的 分 布 式 制造 系统 最 有 和 希望 成 为 下 一 代 制 造 业 的 生产 模式 。 

(4) 智能 化 控制 技术 随 着 人 工 智能 技术 的 发 展 ， 神 经 网 络 和 模糊 逻辑 技术 的 融合 已 
成 为 当前 人 们 的 研究 热点 。 神 经 网 络 具 有 很 强 的 自学 习 、 自 适应 、 大 规模 并 行 运算 和 精确 计 
算 的 能 力 ; 而 模糊 逻辑 在 专家 可 预见 的 论 域 上 有 良好 的 收敛 性 ， 在 进行 模糊 量 的 运算 上 有 优 
势 。 因 此 ， 两 者 结合 可 以 优势 互补 ， 从 而 大 大 提高 综合 性 能 。 在 国内 ,借助 于 神经 网 络 构 成 
自学 习 模 糊 控 制 器 ， 已 成 功 地 实现 脉冲 GTAW 焊 的 正面 熔 宽 控制 和 TIG 焊 的 熔 宽 控制 。 

(5) 焊接 机 器 人 控制 系统 ”机 器 人 控制 系统 将 重点 研究 开放 式 、 模 块 化 控制 系统 。 计 
算 机 语言 、 图 形 编程 与 人 的 交流 界面 更 加 友好 。 机 器 人 控制 器 的 标准 化 和 网 络 化 ， 以 及 基于 
PC 网 络 式 控制 器 已 成 为 研究 热点 。 编 程 技术 除 进 一 步 提 高 在 线 编程 的 可 操作 性 之 外 ， 离 线 
编程 的 实用 化 将 成 为 研究 重点 。 此 外 ， 焊 接 机 器 人 的 遥控 及 监控 技术 、 机 器 人 半 自 主 和 自主 
技术 、 多 机 器 人 和 操作 者 之 间 的 协调 控制 ， 通 过 网 络 建立 大 范围 内 的 机 器 人 遥控 系统 ， 在 有 
时 延 的 情况 下 ， 建 立 预先 显示 进行 遥控 等 方面 ， 都 是 未 来 焊接 机 器 人 的 发 展 方向 。 


8. 4. 3 搬运 机 器 人 系统 组 成 及 应 用 


搬运 机 器 人 (Transfer Robot) ， 是 主要 从 事 自 动 化 搬运 作业 的 机 器 人 。 所 谓 搬 运作 业 是 
旨 用 一 种 设备 握 持 工件 ， 从 一 个 位 置 移 到 另 一 个 位 置 。 工 件 搬 运 和 机 床上 下 料 是 机 器 人 的 一 
个 重要 应 用 领域 ， 在 机 器 人 的 构成 比例 中 占有 较 大 的 比重 。 

1. 搬运 机 器 人 系统 组 成 

搬运 机 器 人 系统 由 搬运 机 械 手 和 周边 设备 组 成 。 搬 运 机 械 手 可 用 于 搬运 重 达 几 千克 至 1 
吨 以 上 的 负载 。 微 型 机 械 手 可 搬运 轻 至 几 克 其 至 几 毫 克 的 样品 ， 用 于 传送 超 净 实验 室内 的 样 
品 。 周 边 设 备 包 括 工件 自动 识别 装置 、 自 动 起 动 和 自动 传输 装置 等 。 搬 运 机 带 人 可 安装 不 同 
的 末端 执行 器 〈 如 机 械 手 爪 、 真 空 吸盘 及 电磁 吸盘 等 ) 以 完成 各 种 不 同形 状 和 状态 的 工件 
搬运 工作 。 

2. 搬运 机 器 人 的 应 用 

最 早 的 搬运 机 器 人 出 现在 1960 年 的 美国 ，Versatran 和 Unimate 两 种 机 器 人 首次 用 于 搬 
运作 业 。20 世纪 80 年 代 以 来 ， 工 业 发 达 国 家 在 推广 搬运 码 志 的 自动 化 、 机 需 人 化 方面 得 到 
了 显著 的 进展 。 日 本 、 德 国 等 国家 在 大 批量 生产 ， 如 机 械 、 家 电 、 食 品 、 水 泥 、 化 肥 等 行业 
广泛 使 用 搬运 机 器 人 。 搬 运 机 器 人 的 应 用 如 图 ol " 
8-12 所 示 。 


8. 4.4 喷涂 机 器 人 系统 组 成 及 应 用 


喷涂 机 器 人 是 用 于 喷漆 或 喷涂 其 他 涂料 等 的 
机 器 人 。 

1. 喷涂 机 器 人 系统 组 成 

喷涂 机 器 人 主要 由 机 器 人 本 体 、 计 算 机 和 相 
应 的 控制 系统 组 成 ， 配 有 自动 喷枪 、 供 漆 装 置 、 大 
变更 颜色 装置 等 喷涂 设备 。 图 8-12 FUJIACE 搬运 机 器 人 应 用 
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喷涂 机 器 人 采用 液压 驱动 较 多 。 液 压 驱 动 的 喷涂 机 融 人 还 包括 液压 源 ， 如 液压 条 、 油 箱 
和 电动 机 等 ， 如 图 8-13 所 示 。 机 器 人 多 采用 5~6 个 自由 度 关 节 式 结构 ,手臂 有 较 大 的 运动 
空间 ， 并 可 做 复杂 的 轨迹 运动 。 其 腕 部 一 般 有 2~3 个 自由 度 ， 可 灵活 运动 。 较 先进 的 喷涂 
机 器 人 腕 部 采用 柔性 手腕 ， 既 可 向 各 个 方向 弯曲 ， 又 可 转动 ， 其 动作 类 似 人 的 手腕 ， 能 方便 
地 通过 较 小 的 孔 伸 人 工件 内 部 ， 喷 涂 其 内 表面 。 动 作 速 度 快 、 有 良好 的 防爆 性 能 ， 其 示 教 方 
式 以 连续 轨迹 示 教 为 主 ， 也 可 做 点 位 示 教 。 







































































图 8-13 ”喷涂 机 右 人 系统 组 成 医 
1 一 机 械 手 ”2 一 液压 站 ”3 一 机 器 人 控制 柜 4、12 一 防爆 器 
5 一 传送 带 6 一 电动 机 “7 一 测速 发 电机 “8 一 喷枪 ”9 一 高 压 
静电 发 生 器 “10 一 塑 粉 回收 装置 “11 一 粉 桶 /高 压 静电 发 生 器 
13 一 电源 ”14 一 气 源 ”15 一 烘 道 
























































2. 防爆 功能 的 实现 

喷涂 机 器 人 的 电动 机 、 电 器 接线 盒 、 电 缆 线 等 都 应 密封 在 壳 体 内 ， 使 它们 与 危险 的 易 燃 
气体 隔离 ， 同 时 配备 一 套 空气 净化 系统 ， 用 供 气 管 向 这 些 密封 的 壳 体内 不 断 地 运送 清洁 的 、 
不 可 燃 的 、 高 于 周围 大 气压 的 保护 气体 ， 以 防止 外 界 易 燃 气体 的 进入 。 机 器 人 按 此 方法 设计 
的 结构 称 为 通风 式 正 压 防爆 结构 。 

3. 应 用 实例 

计算 机 控制 的 喷涂 机 器 人 早 在 1975 年 “ 贰 二 -- 
就 投入 运用 。 由 于 能 够 代 蔡 人 在 危险 和 恶劣 
环境 下 进行 喷涂 作业 ， 所 以 喷涂 机 器 人 日 益 
广泛 应 用 于 汽车 车 体 、 仪 表 、 家 电 产 品 、 陶 
次 和 各 种 塑料 制品 的 喷涂 作业 。 图 8-14 所 
示 为 Motoman 喷涂 机 器 人 在 喷涂 的 示意 图 。 


8. 4. 5 装配 机 器 人 系统 组 成 及 应 用 


装配 机 器 人 (Assembly Robot) ， 是 为 完 
成 装配 作业 而 设计 的 机 器 人 。 装 配 作业 的 主 
要 操作 是 : 垂直 向 上 抓 起 零 部 件 ， 水 平移 动 
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8-14 ”Motoman 喷涂 机 器 人 在 喷涂 的 示意 图 
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它 ， 然 后 垂直 放下 插入。 通常 要 求 这 些 操作 进行 得 既 快 又 平稳 ， 因 此 ， 一 种 能 够 沿 着 水 平和 
穗 直 方向 移动 ， 并 能 对 工作 平面 施加 压力 的 机 器 人 是 最 适 于 装配 作业 的 。 

1. 装配 机 器 人 的 组 成 

装配 机 器 人 是 柔性 自动 化 装配 系统 的 核心 设备 ， 由 机 器 人 操作 机 、 控 制 器 、 末 端 执 行 器 
和 传 感 系统 组 成 。 

2. 装配 机 器 人 的 种 类 和 特点 

水 平 多 关节 装配 机 器 人 是 由 连接 在 机 座 上 的 两 个 水 平 旋转 关节 ( 即 大 小 臂 )、 沿 升降 方 
向 运动 的 直线 移动 关节 、 末 端 手 部 旋转 轴 共 4 个 自由 度 构成 。 它 是 特别 为 装配 而 开发 的 专用 
机 器 人 ， 其 结构 特点 表现 为 治 升降 方向 的 刚度 高 ， 水 平 旋转 方向 的 刚度 低 ， 因 此 称 之 为 平面 
双关 节 型 机 器 人 (SCARA : Selective Compliance Assembly Robot Arm)。 它 的 作业 空间 与 占 地 
面积 比 很 大 。 
直角 坐标 装配 机 器 人 ， 有 具有 3 个 直线 移动 关节 。 空 间 定位 只 需要 3 轴 和 运动， 末端 姿态 不 
发 生变 化 。 该 机 器 人 的 种 类 繁多 ， 从 小 型 、 廉 价 的 桌面 型 到 较 大 型 应 有 尽 有 ， 而 且 可 以 设计 
成 模块 化 结构 以 便 加 以 组 合 ， 是 一 种 很 方便 的 机 器 人 。 它 的 缺点 是 尽管 结构 简单 ， 便 于 与 其 
他 设备 组 合 ， 但 与 其 占 地 面积 相 比 ， 工 作 空间 较 小 。 
垂直 多 关节 装配 机 器 人 人， 通常 由 转 动 和 旋转 轴 构 成 六 自由 度 机 器 人 ， 它 的 工作 空间 与 占 
地 面积 之 比 是 所 有 机 器 人 中 最 大 的 ， 控 制 六 自由 度 就 可 以 实现 位 置 和 姿态 的 定位 ， 即 在 工作 
空间 内 可 以 实现 任何 姿态 的 动作 。 因 此 ， 它 通常 用 于 多 方向 的 复杂 装配 作业 ， 以 及 有 三 维 轨 
迹 要 求 的 特种 作业 场合 。 

3. 装配 机 器 人 的 应 用 

装配 机 器 人 的 大 量 工作 是 轴 与 孔 的 装配 。 为 了 在 轴 与 孔 存 在 误差 的 情况 下 进行 装配 ， 应 
使 机 器 人 具有 柔顺 性 ， 即 自动 对 准 中 心 孔 的 能 力 。 与 一 般 机 器 人 相 比 ， 装 配 机 器 人 具有 精度 
高 、 柔 顺 性 好 、 工 作 范 围 小 、 能 与 其 他 系统 配套 使 用 等 特点 ， 主 要 用 于 各 种 电 带 制造 ( 包 
括 家 用 电器 ， 如 电视 机 、 录 音 机 、 洗 衣 机 、 电 冰箱 、 吸 坐 器 ) 、 小 型 电 劲 机 、 汽 车 及 其 零 部 
件 、 计 算 机 、 玩 具 、 机 电 产 品 及 其 组 件 的 装配 等 方面 。 图 8-15 所 示 为 精密 装配 机 器 人 在 装 
配 作业 。 

下 面 以 精密 装配 机 器 人 应 用 为 例 进 行 介绍 。 机 构 零 部 件 的 较 好 装配 ， 尤 其 是 带 有 配合 要 
求 的 精密 插入 装配 ， 对 于 人 工装 配 来 说 ， 需 要 相当 熟练 的 经 验 才能 进行 ， 且 主要 靠 的 是 手指 
精细 感觉 ， 进 行 修 正和 插入 动作 ; 对 于 精密 装配 机 器 人 而 言 ， 需 要 具有 感觉 功能 和 和 柔性 机 
构 ， 才 能 使 得 孔 轴 间 际 为 10pm 的 精密 装配 由 机 器 人 来 实现 。 因 此 ， 精 密 插 入 闭 配 机 咒 人 需 
要 具有 确定 位 置 、 一 定 的 感 党 和 机 构 的 柔性 功能 。 

图 8-15 所 示 机 顺 人 为 带 有 力 反馈 机 构 的 精密 插入 装配 机 器 人 ， 该 机 器 人 将 3 个 零件 基 
座 、 连 接 套 和 小 轴 组 装 起 来 ， 它 的 视觉 是 采用 电视 摄像 机 。 主 、 辅 机 器 人 各 抓 取 所 需 组 装 的 
零件 ， 两 者 互相 配合 ， 使 零件 尽量 接近 ， 由 主机 器 人 向 孔 的 中 心 方向 移动 。 由 于 手腕 的 柔 
性 ， 所 抓 取 的 小 轴 会 产生 稍微 的 倾斜 ;， 当 小 轴 端 部 到 达 孔 的 位 置 附近 ， 由 于 弹簧 力 的 作用 ， 
轴 端 会 落 入 孔 内 。 和 柔性 机 构 在 z 方 向 的 位 移 变化 可 以 检测 ， 使 主机 器 人 控制 装置 获得 探索 阶 
段 已 完成 的 信息 。 进 入 搬入 阶段 ， 由 触觉 传感器 检测 轴 对 中 心 线 的 倾斜 方向 ;一边 对 轴 的 姿 
态 进 行 修 正 ， 一 边 进行 插入 ， 完 成 装配 作业 。 因 此 ， 此 种 机 器 人 的 技术 关键 ， 就 是 手 爪 的 触 
觉 和 手腕 的 顺应 性 。 解 决 该 关键 技术 的 方法 是 : 主机 器 人 的 柔性 手腕 的 触觉 用 几 个 应 变 片 触 
































































































































199 

















| 工业 机 器 人 及 其 应 用 





觉 传感器 制 成 力 反 馈 手 扑 ， 用 弹簧 片 
制 成 柔性 手腕 ; 手 抓 取 轴 类 零件 后 ， 
逐渐 接触 到 带 孔 的 轴 套 ， 施 以 微小 的 
作用 力 , 使 其 两 者 进行 装配 ; 在 装配 
作业 中 ，x、y、z 方向 的 力 传感器 输出 
的 力 变 化 信号 ， 就 成 为 装配 过 程 的 控 
的 小 轴 插 入 间 际 量 为 7~32pm 的 孔 内 ， 
插入 深度 为 10mm。 搬 和 人 时 间 为 1s 左 
右 ， 比 人 工 插 得 快 ; 插入 完毕 后 ， 由 
行程 开关 发 出 结束 信号 。 图 8-15 所 示 
的 精密 装配 机 器 人 ,不 仅 可 以 用 于 轴 

















套 类 机 构 零 件 的 装配 ， 也 可 用 于 自动 图 8-15 ”精密 装配 机 器 人 在 装配 示意 图 

化 生产 线 上 电子 元 器 件 、 集 成 电路 板 1 一 主机 器 人 “2 一 柔性 手腕 ”3、5 一 触觉 传感器 
村 > 当主 汉 大 内 4 一 弹簧 片 ”6 一 基 座 零件 的 传送 与 定位 7 一 畏 

ee ae 助 机 器 人 8 一 连 套 供 料 系统 ”9 一 小 轴 供 料 系 统 





机 等 的 在 线 组 装 工作 。 
8.5 机 费 人 的 发 展 趋势 


目前 ， 根 据 社 会 的 发 展 和 科学 技术 的 进步 ， 机 器 人 将 向 智能 化 、 横 块 化 、 微 型 化 、 系 统 
化 、 网 络 化 、 多 样 化 等 方向 发 展 ， 其 发 展 趋势 如 下 。 

1. 传 感 型 智能 化 机 器 人 发 展 迅速 

1) 作为 传 感 机 器 人 基础 的 传 感 技术 将 不 断 发 展 ， 各 种 新 型 传感器 不 断 出 现 。 

2) 多 传感器 集成 和 融合 技术 在 智能 机 器 人 上 将 获得 应 用 。 由 于 单一 传 感 信号 难以 保证 
输入 信息 的 准确 性 和 可 靠 性 ， 不 能 满足 智能 机 器 人 系统 获取 环境 信息 以 及 系统 决策 能 力 。 采 
用 多 传感器 集成 和 融合 技术 ， 利 用 各 种 传 感 信息 ， 获 得 对 环境 的 正确 理解 ， 使 机 器 人 系统 具 
有 容错 性 ， 保 证 系统 信息 处 理 的 快速 性 和 正确 性 。 

3) 在 多 传感器 集成 和 融合 技术 研究 方面 ， 人 工 神 经 网 络 的 应 用 特别 引 人 和 人 注目， 成 为 一 
个 研究 热点 。 

2. 开发 新 型 智能 技术 

1) 虚拟 现实 技术 是 新 近 研 究 的 智能 技术 ， 它 是 一 种 对 事件 的 现实 性 从 时 间 和 空间 上 进 
行 分 析 后 重新 组 合 的 技术 。 这 一 技术 包括 三 维 计算 机 图 形 学 技术 、 多 功能 传感器 的 交互 接口 
技术 以 及 高 清晰 度 的 显示 技术 。 虚 拟 现实 技 术 可 应 用 于 遥控 机 器 人 和 临场 感 通信 等 。 

2) 形状 记忆 合金 (SMA) 被 誉 为 “智能 材料 ”。SMA 的 电阻 随 温度 变化 而 变化 ， 导 致 
合金 形变 ， 可 用 来 执行 驱动 动作 ， 完 成 传 感 和 驱动 功能 。 

3) 多 智能 机 器 人 系统 (MARS) 是 近年 来 开始 探索 的 又 一 项 智能 技术 ， 它 是 在 单 体 智 
能 发 展 到 需要 协调 作业 的 条 件 下 产生 的 。 多 个 机 器 人 系统 具有 共同 的 目标 ， 完 成 相互 关联 的 
动作 或 作业 。 

4) 在 诸多 新 型 智能 技术 当中 ， 基 于 人 工 神经 网 络 的 识别 、 检 测 、 控 制 和 规划 方法 的 开 



























































200 

















第 8 章 ” 机 器 人 设计 方法 和 应 用 及 其 发 展 | 





发 和 应 用 占 着 重要 位 置 。 基 于 专家 系统 的 机 器 人 规划 获得 新 的 发 展 ， 除 了 应 用 于 任务 规划 、 
装配 规划 、 搬 运 规划 和 路 径 规 划 外 ， 又 被 用 于 自动 抓 取 规划 等 。 

3. 采用 模块 化 的 设计 技术 
智能 机 器 人 和 高 级 机 器 人 的 结构 要 力求 简单 紧凑 ， 其 高 智能 部 件 甚至 全 部 机 构 的 设计 已 
向 模块 化 方向 发 展 ; 其 驱动 采用 交流 伺服 电动 机 ， 向 小 型 和 高 输出 方向 发 展 ; 其 控制 装置 向 
小 型 化 和 智能 化 发 展 ， 采 用 高 速 CPU 和 32 位 芯片 、 多 处 理 器 和 多 功能 操作 系统 ， 提 高 机 器 
人 的 实时 和 快速 适应 能 力 。 机 器 人 软件 的 模块 化 则 简化 了 编程 ， 发 展 了 离线 编程 技术 ， 提 高 
了 机 器 人 的 控制 系统 的 适应 性 。 

4. 微型 机 器 人 的 研究 有 所 突破 

1) 微型 机 器 和 微型 机 器 人 为 21 世纪 的 尖端 技术 之 一 。 微 型 驱动 器 是 开发 微型 机 器 人 
的 基础 和 关键 技术 之 一 。 

2) 在 大 中 型 机 器 人 和 微型 机 器 人 系列 之 间 ， 还 有 小 型 机 器 人 。 小 型 化 也 是 机 器 人 发 展 
的 一 个 趋势 。 

5. 机 器 人 的 应 用 领域 向 非 制造 业 和 服务 业 扩 展 

机 器 人 的 应 用 领域 不 断 向 非 制造 业 和 服务 业 扩 展 ， 下 面 为 非 制造 业 应 用 智能 机 器 人 技术 
的 一 些 典 型 例子 。 

(1) 太空 领域 空间 站 服务 机 器 人 (装配 、 检 查 和 修理 ) ， 机 器 人 卫星 (空间 会 合 、 对 
接 与 轨道 作业 ) ， 飞 行 机 器 人 (人员 和 材料 运送 及 通信 ) ， 空 间 探索 (星球 探测 等 ) 和 资源 
收集 ， 太 空 基地 建筑 ， 卫 星 回收 以 及 地 面 实验 平台 等 。 

(2) 海洋 领域 海底 普查 和 采矿 机 器 人 ,海上 建筑 的 建设 与 维护 ， 海 滩 救 援 机 器 人 ， 
海 况 检测 与 预报 系统 。 

(3) 建筑 领域 ” 钢 结构 自动 加 工 系统 ， 防 火 层 喷涂 机 器 人 人， 混凝土 地 板 研磨 机 器 人 ， 
外 墙 装修 机 器 人 人， 顶棚 和 灯具 安装 机 器 人 ， 外 墙 清洗 、 喷 涂 、 检 测 和 瓷砖 铺设 机 器 人 ， 钢 筋 
混凝土 结构 检测 机 器 人 ， 桥 梁 自 动 喷涂 、 小 管道 和 电缆 地 下 铺设 机 器 人 人， 混凝土 预制 板 自动 
安装 机 器 人 等 。 

(4) 采矿 领域 金属 和 煤炭 自动 采 据 机器人， 矿井 安全 监督 机 器 人 。 

(5) 电力 领域 ” 配 电 线 带 电 作 业 机 器 人 ， 绝缘子 自动 清洗 ， 变 电 所 自动 巡视 机 器 人 ， 
核电 站 反应 堆 检 查 与 维护 机 器 人 ， 核 反应 堆 拆 纯 机 器 人 等 。 

(6) 煤气 及 供水 领域 ”管道 安装 、 检 查 和 修理 机 器 人 ， 容 器 检查 、 修 理 和 喷涂 机 器 人 。 

(7) 农林 渔业 领域 前 羊毛 机 器 人 ， 和 森林 自动 修剪 和 砍伐 机 器 人 ,鱼肉 自动 去 骨 、 切 
片 、 分 选 和 包装 机 器 人 。 

(8) 医疗 领域 ”神经 外 科 感 知 机 器 人 ， 胸 部 肿瘤 自动 诊断 机 器 人 ， 体 内 器 官 和 脉 管 检 
查 及 手术 微型 机 器 人 ， 用 于 外 科 手 术 的 多 只 手机 器 人 等 。 

(9) 社会 福利 领域 老年 人 和 卧床 不 起 的 病人 护理 机 器 人 ,残疾 人 员 支 援 系统 ， 人 工 假肢 等 。 

6. 开发 敏捷 的 制造 生产 系统 

1) 机 器 人 必须 改变 过 去 那 种 “部 件 发 展 方式 ”， 而 优先 考虑 “系统 发 展 方式 ”。 机 器 人 
作为 高 精度 、 高 柔性 的 敏捷 性 加 工 设备 的 时 代 必 将 到 来 。 不 论 机 器 人 在 生产 线 上 起 什么 样 的 
作用 ， 它 总 是 作为 系统 中 的 一 员 而 生存 。 

2) 通用 的 机 器 人 编程 语言 仍 是 动作 级 语言 ， 虽 然 开 发 了 很 多 任务 级 语言 ， 但 大 多 不 实 
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用 。 随 着 面向 对 象 技术 的 发 展 以 及 离线 编程 技术 的 成 熟 ， 任 务 级 语言 可 能 会 日 趋 成 熟 。 但 现 
在 可 以 预见 未 来 ， 由 于 任务 的 复杂 性 ， 实 用 的 语言 仍 将 是 动作 级 语言 。 

3) 机 器 人 的 编程 与 机 床 的 数控 设备 一 样 ， 完 全 可 以 实现 离线 编程 ， 再 加 上 易于 大 规模 
安全 修改 的 软件 ， 就 可 实现 “敏捷 制造 生产 线 ”。 





8.6 机 器 人 与 人 类 社会 


随 着 机 需 人 技术 的 发 展 ， 未 来 机 器 人 与 人 类 社会 将 会 产生 更 加 紧密 的 关系 。 因 此 ， 机 器 
人 的 “人 性 化 ”是 当代 科技 的 主题 。 作 为 一 个 特殊 的 领域 ,科学 家 对 机 器 人 的 “人 性 化 ” 
还 有 一 个 专门 的 注解 。“ 类 人 化 ”是 指 未 来 的 机 器 人 能 和 人 一 样 进行 “人 一 机 ”和 “机 一 
机 ”的 交流 ， 以 及 在 各 种 复杂 或 者 危险 的 工作 中 用 机 器 人 替代 人 来 进行 实际 操作 。 虽 然 许 
多 发 达 国家 已 经 有 了 某 些 智能 化 机 器 人 ， 但 是 这 些 机 器 人 的 “智能 ”都 是 通过 预 置 的 计算 
机 程序 获取 的 。 科 学 家 指出 ， 灵 活 的 机 械 构造 和 具有 “自主 性 ”的 软件 系统 是 造 出 真正 
“类 人 化 ”机 顺 人 的 关键 。 预 计 未 来 机 器 人 将 在 以 下 几 个 研究 领域 中 显现 出 来 。 

(1) 机 器 人 医生 ”在 未 来 ， 如 果 你 要 接受 手术 ， 给 你 开刀 的 也 许 不 是 外 科 医 生 ， 而 是 
机 融 人 。 例 如 ， 美 国内 布 拉 斯 加 医学 中 心 的 研究 人 员 人 研发 了 一 种 微型 的 “手术 机 器 人 ”。 该 
机 器 人 用 于 协助 外 科 医 生 实施 手术 。 它 由 两 个 旋转 探头 组 成 ， 其 总 直径 只 有 lmm。 虽 然 操 
刀 的 是 医生 ， 但 是 它 在 手术 中 扮演 着 很 重要 的 角色 。 它 不 仅 承担 了 所 有 的 信息 任务 ， 而 且 具 
有 高 灵敏 度 的 探头 ， 能 在 腹腔 中 自由 游 走 ， 为 医生 提供 细致 人 微 的 病人 体内 图 像 ;， 机 身上 带 
有 可 回收 的 探头 ， 能 为 医生 带 去 切片 检查 的 样本 。 此 外 ,平滑 的 外 形 设计 使 它 不 会 对 体内 的 
器 官 和 组 织造 成 伤害 。 小 巧 轻便 的 机 身 ， 只 需要 很 小 的 创口 便 能 放 入 体内 ， 给 病人 造成 的 痛 
昔 远 小 于 内 宇 镜 。 

(2) 太空 机 器 人 ”虽然 “ 载 人 航天 ”的 技术 已 经 实现 ， 但 是 人 所 能 达到 的 太空 范围 是 
很 有 限 的 ， 更 大 范围 的 太空 探测 ， 将 由 机 器 人 移行 一 步 “宇航 员 机 器 人 ”是 未 来 太空 
探测 的 首选 ， 如 美国 太空 总 署 设计 了 太空 机 器 人 。 

(3) 救灾 机 器 人 如果 在 救援 中 使 用 机 器 人 ,那么 救援 工作 的 效率 将 大 大 提高 。 首 先 ， 
傍 摄 像 头 和 气体 探测 器 的 机 器 人 能 辫 洞 进入 地 下 ， 以 最 短 的 时 间 获 取 地 下 的 情况 。 在 获得 有 
关 数 据 之 后 ， 机 絮 人 能 迅速 制订 最 有 效 的 救援 方案 。 当 机 器 人 找到 被 救 者 ， 它 能 与 被 救 者 进 
行 交 流 ， 以 判断 被 救 者 的 状态 。 由 此 可 见 ， 机 器 人 在 救灾 中 是 极其 实用 的 。 

随 着 社会 的 发 展 ， 社 会 分 工 越 来 越 细 ， 于 是 人 们 研制 出 了 机 器 人 ， 代 替 人 完成 那些 村 
燥 、 单 调和 危险 的 工作 。 但 机 器 人 的 问世 带 来 了 一 定 的 社会 问题 ， 有 人 对 机 融 人 产生 了 政 
意 。 任 何 新 事物 的 出 现 都 有 利 有 弊 ， 只 不 过 利 大 于 弊 ， 很 快 就 得 到 了 人 们 的 认可 。 

美国 是 机 器 人 的 发 源 地 ， 但 其 发 展 远 没有 日 本 迅速 ， 其 中 部 分 原因 就 是 因为 美国 不 欢迎 
机 器 人 ， 日 本 之 所 以 能 迅速 成 为 机 器 人 大 国 ， 其 中 很 重要 的 一 条 就 是 当时 日 本 劳动 力 短缺 ， 
政府 、 企 业 和 国民 都 希望 发 展 机 器 人 。 由 于 使 用 了 机 器 人 ， 它 的 汽车 、 电 子 工业 迅速 崛起 ， 
很 快 占领 了 世界 市 场 。 从 现在 世界 工业 发 展 的 潮流 看 ， 发 展 机 器 人 是 一 条 必由之路 。 没 有 机 
器 人 ， 人 将 变 为 机 器 ， 有 了 机 融 人 ， 人 仍然 是 主人 。 

不 论 是 工业 机 器 人 ， 还 是 特种 机 器 人 ， 都 存在 一 个 与 人 相处 的 问题 ， 最 重要 的 是 不 能 伤 
害 人 。 然 而 由 于 某 些 机 器 人 系统 的 不 完善 ， 在 机 器 人 使 用 的 前 期 ， 引 发 了 一 系列 意 想 不 到 的 
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事故 。 专 家 认为 ， 机 器 人 发 生 事故 的 原因 主要 有 三 种 : 中 硬件 系统 故障 ; @ 软 件 系统 故障 ; 
@ 电 磁 波 的 干扰 。 

这 种 意外 伤 人 事件 是 偶然 也 是 必然 的 ， 因 为 任何 一 个 新 生 事物 的 出 现 总 有 其 不 完善 的 一 
面 。 随 着 机 器 人 技术 的 不 断 发 展 与 进步 ， 这 种 意外 伤 人 事件 会 越 来 越 少 。 正 是 由 于 机 器 人 安 
全 、 可 靠 地 完成 了 人 类 交 给 的 各 项 任务 ， 使 人 们 使 用 机 器 人 的 热情 才 越 来 越 高 。 

“ 工 欲 善 其 事 ， 必 先 利 其 器 ” 。 人 类 在 认识 自然 、 改 造 自然 、 推 动 社会 进步 的 过 程 中 ， 
不 断 地 创造 出 各 种 各 样 为 人 类 服务 的 工具 ， 其 中 许多 具有 划时代 的 意义 。 作 为 20 世纪 自动 
化 领域 的 重大 成 就 ， 机 带 人 已 经 和 人 类 社会 的 生产 、 生 活 密 不 可 分 。 世 间 万 物 ， 人 力 是 第 一 
资源 ， 这 是 任何 其 他 物质 不 能 替代 的 。 尽 管 人 类 社会 本 身 还 存在 着 不 文明 、 不 平等 的 现象 ， 
甚至 还 存在 着 战争 ， 但 是 ， 社 会 的 进步 是 历史 的 必然 ， 所 以 ,我 们 完全 有 理由 相信 ， 像 其 他 
许多 科学 技术 的 发 明 发 现 一样 ， 机 器 人 也 应 该 成 为 人 类 的 好 助手 、 好 朋友 。 

我 们 坚信 ， 作 为 人 类 创造 的 产物 一 一 机 器 人 ， 无 论 发 展 到 何 种 阶段 ， 它 永远 是 人 的 附属 
品 ， 它 们 的 大 脑 再 发 达 ， 也 必须 有 人 去 创造 。 例 如 ， 我 们 可 为 高 级 机 器 人 安 上 一 个 “关闭 
键 ”"， 如 果 它 们 因 “ 发 疡 ”而 攻击 人 类 ， 那 么 装 在 它们 映 上 的 那个 “关闭 键 ” 就 可 以 上 自动 关 
闭 电源 。 因 此 ， 人 们 大 可 不 必 对 机 器 人 的 进化 感到 危机 和 怒 恨 ,大胆 地 研究 、 开 发 和 使 用 机 
器 人 吧 ! 















































8.7 本 竟 小 结 


本 草 主 要 介绍 了 机 占 人 设计 的 一 般 原则 、 方 法 和 步 台 ,分 析 了 工业 机 器 人 和 特种 机 器 人 
的 设计 实例 。 简 要 地 介绍 了 机 顺 人 的 应 用 和 发 展现 状 ， 分 析 了 机 器 人 与 人 类 之 间 的 关系 。 本 
章 的 目的 在 于 使 读者 对 机 器 人 的 应 用 和 发 展 有 一 个 整体 的 了 解 ， 为 应 用 和 研究 机 器 人 提供 理 


论文 撑 。 











习 题 


8-1 简 述 工业 机 器 人 与 特种 机 器 人 的 区 别 。 
8-2 ”论述 机 器 人 与 人 类 社会 之 间 的 关系 。 
8-3 简 述 机 器 人 发 展 趋势 。 

8-4 应 用 工业 机 器 人 时 ， 必 须 考 虑 哪些 因素 ? 
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